盘一盘！实时自动驾驶车辆定位技术都有哪些？（视觉/Lidar/多传感器数据融合）...

点击下方卡片，关注“自动驾驶之心”公众号

ADAS巨卷干货，即可获取

点击进入→自动驾驶之心【SLAM】技术交流群

后台回复【车辆定位综述】获取论文！

1摘要

实时、准确和鲁棒的定位对于自动驾驶汽车（AVs）实现安全、高效驾驶至关重要，而实时性能对于AVs及时实现其当前位置以进行决策至关重要。迄今为止，没有一篇综述文章定量比较了基于各种硬件平台和编程语言的不同定位技术之间的实时性能，并分析了定位方法、实时性能和准确性之间的关系。因此，本文讨论了最先进的定位技术，并分析了它们在AV应用中的整体性能。为了进一步分析，本文首先提出了一种基于定位算法操作能力（LAOC）的等效比较方法，以比较不同定位技术的相对计算复杂性；然后，全面讨论了方法论、计算复杂性和准确性之间的关系。分析结果表明，定位方法的计算复杂性最大相差约107倍，而精度相差约100倍。与基于激光雷达的定位相比，基于视觉和数据融合的定位技术在提高精度方面的潜力约为2–5倍。基于激光雷达和视觉的定位可以通过提高图像配准方法的效率来降低计算复杂性。与基于激光雷达和视觉的定位相比，基于数据融合的定位可以实现更好的实时性能，因为每个独立传感器不需要开发复杂的算法来实现其最佳定位潜力。V2X技术可以提高定位鲁棒性。最后，讨论了基于定量比较结果的AVs定位的潜在解决方案和未来方向。

2介绍

自动驾驶车辆（AVs）有望在未来的智能交通系统中发挥关键作用，因为它们在确保安全驾驶、缓解交通压力和降低能耗方面具有潜力。目前对AVs的研究已进入道路测试阶段。例如，百度已经在复杂的道路场景中测试了Apollo 5.0系统，例如没有特殊标记的弯道或十字路口[1]。谷歌Waymo项目也在美国公共道路上完成了1000多万英里的路测，并在模拟中完成了70亿英里的路测[2]。然而，在AVs商业化之前，该行业仍需要应对几个关键挑战。这些挑战包括a）提出实时、准确和低成本的自定位解决方案；b）实现实时和准确的环境感知模型；c）在复杂场景中实现智能、安全和高效的决策。同时，环境感知和决策模块显著依赖于自动驾驶汽车的实时和准确的自定位，以实现安全驾驶。因此，自定位是AV的核心要素之一。此外，只有当自动定位达到毫秒级实时性能和厘米级精度时，才能确保安全驾驶，如避免碰撞[3]。

作为一种典型的方法，地图匹配算法广泛应用于许多配备激光雷达[4]、雷达[5]、相机[6]或V2X[7]的定位解决方案中。地图匹配方法之一是使用现有地图来匹配检测到的环境特征（例如，拐角和道路标记），从而获得车辆位置信息。另一种技术是在应用程序中使用的SLAM，无需先验地图。它通过同时构建用于顺序映射的环境模型（地图）来实现车辆定位。地图算法主要关注从各种传感器提取的抽象数据，如激光雷达、雷达、相机或它们的组合。在基于传感器的定位技术方面，它依靠车载传感器来估计车量车辆的绝对或相对位置。之前的综述对其进行了详细讨论[8]。在许多基于传感器的定位研究中，“传感器”被视为主要的定位传感器，作者试图探索一种主要基于其测量的创新方法，旨在解决某些特殊场景中的定位挑战。这并不意味着定位系统仅使用单个传感器来实现车辆定位。作为解释这一概念的示例，对于基于IMU的定位，参考文献[9]提出了一种交互多模型（IMM）方法，通过使用IMU和里程计传感器数据来消除由全球定位系统（GPS）中断或GPS信号块引起的系统漂移，从而提高了此类驾驶场景中的定位鲁棒性和完整性性能。基于传感器的定位技术可以指导AV定位系统的部署，包括如何选择能够满足实时性能的传感器、定位算法、融合算法和计算资源。此外，关注定位输入（传感器硬件）可以让读者更好地了解不同系统部署在准确性、实时性、鲁棒性和成本方面的优缺点。因此，本次调查将从车载传感器开始，讨论不同的基于传感器的定位技术，然后讨论V2X定位技术，最后讨论基于数据融合的定位。

图1显示了车辆不同自定位技术，包括车载传感器、V2X和基于数据融合的技术。基于车载传感器的定位系统，包括基于主动和被动传感器的技术，依靠车载传感器感知周围环境，然后估计车辆位置。基于V2X的定位方法与周围环境节点（例如，相邻车辆或基础设施）通信，以接收其位姿信息，包括基于车辆对车辆（V2V）和车辆对基础设施（V2I）的技术，这些技术可以为定位算法提供多个参考坐标。数据融合不是一种直接感测位置的方法，而是一种后处理定位感测技术。其目标是融合各种传感器的测量结果，以获得比单个传感器更好的结果。

基于主动传感器的定位通过车载传感器（包括激光雷达、雷达和超声波传感器）主动感知周围环境以估计车辆位置。它们的测距原理是相同的，这是基于到达时间（TOA）方法的。它们的区别在于信号载体，即激光雷达、雷达和超声波传感器的激光、无线电和超声波。信号载波波长的差异导致这些传感器的成本和精度的显著变化。例如，激光雷达通常成本最高，但精度最好，超声波[10]-[13]的情况正好相反。

基于被动传感器的定位被动地接收环境信息，从中计算车辆位置。传感器包括GPS、IMU和视觉（例如，单目或双目摄像机）。根据空间三角测量方法，GPS需要在开阔的天空区域中有三颗或更多的卫星来获取车辆位置（2–10m）。GPS的优点是成本低，但在城市环境中，它经常遭受多径和nonline-of-sight（NLOS）误差以及缓慢的位置更新率。IMU使用高频采样率（>100Hz）测量车辆加速度和转速。因此，可以通过给定初始姿态的航位推算来推导车辆的位置和方向[14]。尽管IMU具有快速的位置刷新率和高可靠性，但它也容易出现大量累积错误。基于视觉的定位通过使用来自单目或双目相机的图像作为输入来估计车辆位置。这类似于根据平面三角测量确定障碍物位置的人类视觉系统。图像中丰富的环境信息可以在适当的照明条件下提供令人满意的定位性能，但消耗大量的内存和计算资源。

基于V2V的定位是指vehicular ad hoc network（VANET）下的自动驾驶车辆，使用专用短程通信（DSRC）或长期演进技术来确定其他车辆的位姿，从而提高车辆的位置精度。基于V2I的定位是指目标车辆和静态基础设施之间的通信，使用它们的精确已知位置来确定目标车辆位置。基础设施的类型包括磁性标记、射频识别（RFID）标签、路边单元（RSU）和GPS基站。基于V2X的定位具有广泛的全局感知范围（300m[15]），但可能会受到网络延迟和城市拥堵的影响。

已经发表了许多调查，总结了现有的自定位技术，并全面讨论了它们的优缺点以及每种基于传感器的方法的潜在应用。然而，在评估各种定位方法时，最新的综述文件仅关注以下方面：

• a） 经济和可靠的定位技术[8]，其中经济对应于定位系统的成本，可靠对应于定位性能（包括准确性和可靠性），这些技术可以在各种驾驶场景（例如，下雪天气）中实现；

• b） 准确度、可靠性和可用性[16]，其中与定位系统相对应的可用性应在不同环境中可用，例如隧道中基于GPS的定位系统，在通信延迟的情况下的V2V方法；

• c） 鲁棒性和可扩展性[17]，[18]，其中与定位系统相对应的鲁棒性在不同季节和交通条件下以低故障率长时间运行，可扩展性与车辆处理大规模自动驾驶的能力相对应。

自动定位的实时性能是评估AV安全驾驶的关键指标之一。上述调查还提到，研究人员在设计定位系统时应仔细考虑不同技术的计算负载和实时性能。然而，到目前为止，还没有调查对不同的自定位技术的实时性能进行比较和深入讨论。通过比较驾驶员行为对决策过程的反应时间[28]。论文进行了文献综述，以展示从感知障碍物到执行控制动作的时刻，AV行为的反应时间，如表I所示。根据计算机模拟和实际测试，为了满足安全驾驶，AV的整个决策过程的反应时间通常缩短至0.5s。然而，在极端情况下，检测和识别模块、规划和决策模块以及执行模块将占用近0.5秒，这导致为定位模块预留的执行时间非常有限。因此，快速实时定位解决方案可以为AV系统的其他模块（如决策）节省计算资源，以实施复杂的策略以确保安全驾驶。目前，在各种硬件平台和编程语言上呈现了不同定位解决方案的实时性能。直接使用每个自定位研究论文提供的数据来比较实时性能没有意义，也不能反映AV中内存和计算资源的相对消耗。也没有调查对同一基准下各种定位解决方案的计算复杂性进行量化，这与定位系统的实时性能和部署成本有关。本文旨在研究现有的最先进的定位技术，并着重于提出的每种解决方案的创新算法或方法，以及在实时性能、准确性和鲁棒性方面的整体定位性能；提出一种等效方法，定量比较基于各种硬件平台和编程语言的不同定位解决方案之间的相对实时性能；最后总结现有的定位技术，并基于AV中的定量比较结果讨论潜在的解决方案和未来方向。表II总结了论文的调查与最近现有调查之间的关系和差异。

3基于主动传感器的定位

基于激光雷达的定位

基于激光雷达的定位通常需要预先构建参考地图，以与点云数据或激光雷达反射强度数据相匹配。但在没有先验地图的情况下，它将使用SLAM技术构建实时地图以与先前生成的地图匹配。在AVs的应用中，高维地图包含丰富的特征信息，这提高了位置估计精度，但降低了存储效率并增加了处理时间[29]，[30]。

Im等人[31]基于城市道路两侧建筑物的垂直角建立了一维角地图，用于匹配和定位。他们使用迭代端点拟合来提取垂直角的特征，并根据垂直线的长度和方向构建角特征图。然后，他们应用特征匹配和点云数据来计算车辆位置。由于提取的特征信息较少，该方法减少了匹配时间和地图数据文件大小（约14KB/km）。然而，最大水平位置误差达到0.46m；此外，这种方法不适用于没有建筑物的地区。参考文献[32]构建了由基于道路标记的道路反射密集图和基于垂直结构的概率占用网格图组成的2D占用网格图。首先，他们通过提取道路标记和拐角的线条特征，构建了一个1D扩展线地图（ELM）。这些要素仅包含直线两个端点的纬度和经度信息。然后，他们将ELM转换为2D网格地图，以便在定位过程中进行匹配。与[31]相比，[32]增加了道路标记特征以提高准确性性能，但该方法将ELM数据大小增加到134KB/km。

用于激光雷达定位的二维平面地图匹配在当前的研究中非常流行。例如，Levinson等人[4]通过使用SLAM式松弛算法来构建没有任何潜在移动物体的平坦地面反射图，然后使用部分滤波器（PF）来关联激光雷达，从而获得车辆定位。为了进一步提高鲁棒性，参考文献[33]使用了表示为remittance values的高斯分布的概率图，而不是表示为固定infrared remittance values的先前地图。它使地图中的静止物体和一致的角反射率能够通过贝叶斯推断快速识别。然后使用离线SLAM来对齐先前序列地图中的重叠轨迹，这使得定位系统不断学习和改进地图。与参考文献[4]中的方法相比，参考文献[33]提高了动态城市环境中AV的定位精度和鲁棒性。然而，这两种方法的地图数据大小已增加到每英里10MB左右。其他相关算法[29]、[35]—[42]可以参考具体论文。

基于3D地图的匹配可以实现更准确的位置，因为它包含环境对象的高度信息。参考文献[43]通过提取道路标记特征构建了3D地图。然后，系统使用正态分布变换（NDT）来处理不确定信息，之后基于PF推导出鲁棒性和精确定位。然而，3D NDT方法可能需要大量内存来保存ND体素（用于匹配的3D ND体素总数高达100MB[30]），这导致定位时间与second level一样长[44]。Li等人[45]提出构建3D占用网格地图，然后使用混合过滤框架（即cubature Kalman filter和PF的组合）来计算大规模户外定位并减少地图数据大小。尽管数据量减少了，但实验表明，该方法可以保持稳定、可靠的定位性能，这意味着定位误差小于0.097m。

基于雷达的定位

与基于激光雷达和视觉的定位相比，基于雷达的定位可以满足实时性能要求，因为其内存效率高且计算负载低[46]，[47]。然而，基于雷达的SLAM在地图匹配中面临数据配准错误的风险，因为有时会提取不真实的特征，从而导致定位精度低的风险[5]。面向轨迹的扩展卡尔曼滤波器（EKF）-SLAM技术使用傅里叶-梅林变换顺序配准雷达图像，并在不匹配特征的情况下计算车辆位置，以避免此类特征带来的风险。缺点是定位误差达到13m（平均值）[46]。参考文献[48]旨在通过Levy过程扩展半马尔可夫链，以提高长期变化环境中的鲁棒性，83%的估计位置误差小于0.2m。对于雨雪情况，[49]通过对误差传播的不确定性进行建模，然后匹配雷达图像以实现可靠定位，从而建立了参考地图。参考文献[50]提出了一种聚类SLAM技术，该技术使用基于密度的流聚类算法对动态环境中的雷达信号进行聚类。提出了一种无测量噪声的环境扫描用于地图匹配。PF用于使用该匹配结果来计算车辆位置。该技术中使用的地图大小仅为200KB。

此外，参考文献[51]和[52]提出了一种基于空间和多普勒的联合优化框架，以进一步提高定位速度。该框架通过构建稀疏高斯混合模型来表达参考点云，该模型是一种稀疏概率密度函数，可以降低计算复杂性。该方法的定位刷新率可达17Hz。参考文献[47]使用相同道路的雷达扫描数据构建参考地图。然后，使用迭代最近点（ICP）来匹配雷达图像以估计车辆位置。最后，应用EKF平滑估计。由于所需的映射数据的大小较小，该技术减少了地图匹配的计算负载。然而，挑战在于需要从传感器的相同模型中获取最新数据，并从与参考相同的道路中获取样本，以进行匹配。

此外，参考文献[53]设计了一种车载定位探地雷达（LGPR）系统，以构建道路地下地图。该系统可以抵抗复杂天气的信号干扰，因为它的雷达安装在底盘下，用于扫描地面。此外，它可以实现高精度（RMSE为12.7cm）和出色的实时性能（~126Hz刷新率）。然而，作者还提到，LGPR阵列的高度需要进一步降低，以适应更多的乘用车。

基于超声波的定位

由于低成本的超声波传感器，基于超声波的定位被广泛用于室内机器人定位。然而，短的检测距离和对环境温度、湿度和灰尘的敏感性都限制了超声波传感器在AV定位中的广泛应用[54]，[55]。Moussa等人[56]使用EKF算法实现了基于超声波的辅助导航解决方案。当GPS无法限制车辆位置的漂移并增强系统的鲁棒性时，该解决方案使用超声波传感器作为定位的主要传感器。它可以实现出色的实时性能（约92Hz刷新率），但位置误差高达7.11m。Jung等人[13]使用超声波传感器、编码器、陀螺仪和数字磁罗盘，以及SLAM方法来估计车辆的绝对位置。该方法的平均位置更新时间长达10.65s。此外，长时间的SLAM计算过程可能会导致定位系统在位置更新之前由IMU导致的一些累积误差。因此，能够满足位置精度要求的平均行驶距离仅约为5.2m。总之，基于超声的定位技术可以实现低成本和低功耗的定位系统。然而，它的定位精度和鲁棒性仍然不能满足自动驾驶的要求。

讨论

基于激光雷达的地图匹配技术中的准确和鲁棒的特征检测方法可以提高AV定位的准确性和鲁棒性[57]。总之，就基于激光雷达的1D地图匹配技术而言，由于该方法仅采用少数异形线作为特征，例如参考文献[31]和[32]中所示的垂直角，因此特征配准中的计算负载和内存使用量较低。然而，这种方法需要解决路边没有垂直建筑物的情况下的挑战。与1D地图相比，2D地图包含丰富的特征类型，但增加了地图存储空间。基于强度的2D地图方法可以增强积雪路面场景中的道路表示。基于混合地图的算法可以减少内存使用，并解决实时性能和定位精度之间的权衡，例如参考文献[38]中所示的拓扑度量地图。基于3D地图的匹配算法可以获得受益于3D特征的准确和鲁棒的位置。然而，与基于1D地图和2D地图的方法相比，它需要最大的计算资源，这将增加AV定位系统的部署成本。与基于高成本激光雷达的定位相比，雷达是一种经济高效的解决方案，但毫米波雷达获得的环境模型分辨率低，且缺乏物体高度信息，使得定位系统难以实现鲁棒性和准确性。目前，雷达被广泛用作辅助定位传感器，以检测车辆与障碍物之间的距离。超声波传感器的检测范围（约3m）决定了基于超声波的定位主要用于短距离定位应用，例如自动停车，其中几个参考目标位于近距离。

4基于被动传感器的定位

基于GPS的定位

GPS可以为AV提供低成本、高效的定位解决方案。然而，GPS经常受到城市中NLOS、多径或信号阻塞的影响，所有这些都对提供可靠车辆定位的目标提出了挑战[58]，[59]。

当前主流的基于GPS的定位通过位置校正技术提高了准确性和可靠性，包括融合来自不同来源的测量[60]、过滤异常信号[61]和地图辅助[62]。参考文献[63]通过融合来自其他来源（包括GPS、RFID和V2V）的测量结果，改进了基于GPS的定位。作者分析了不同数据源的准确性，并过滤掉了冗余连接。它们只保留具有期望精度的连接，以在GPS降级环境中实现鲁棒性要求。所提出方法的位置精度约为2.9m，计算复杂度约为[64]的0.8%。参考文献[61]提出了一种GPS异常信号识别处理框架，以提高基于GPS的定位的鲁棒性。该框架可以根据原始GPS的质量决定输出原始GPS、估计GPS或去除异常信号的GPS。与前两种技术不同，Lu等人[65]通过匹配低精度开源地图来提高GPS精度。然而，该方法的局限性在于难以提取道路交叉口中的车道标记特征。同时，[66]通过去除异常GPS信号并结合数字地图的地形高度辅助，提出了一种基于全球导航卫星系统（GNSS）的定位方法。参考文献[67]通过匹配NLOS信号延迟提高了GNSS精度。尽管如此，[66]和[67]的位置RMS误差在城市场景中仍高达约10m。总之，使用独立GPS接收机实现可靠、准确的车辆定位是困难的。

基于IMU的定位

IMU是惯性导航系统（INS）的一个组件，可以测量加速度和俯仰率，并具有强大的抗干扰能力[68]。然而，由于累积误差的缺点，自动驾驶系统不能使用IMU计算长距离的位置。在这种情况下，IMU被广泛用作备用传感器或融合源之一，以确保主定位传感器短时中断时的连续定位[69]。

参考文献[70]提出使用基于航位推算（DR）的紧密耦合（TC）方案来提高城市中的精度性能。参考文献[71]使用具有异常GPS测量抑制的修正TC，以在GPS无效环境下实现连续定位。Wang等人[72]提出了一种基于一组自回归、移动平均预测模型和占用网格约束的方案，以进一步提高定位精度；该方案还可以减少DR系统的累积误差和GPS上的多径干扰。其他相关算法[73]-[76]可以参考具体论文。除DR方法外，IMU输出的俯仰率信号的模式识别也可用于计算车辆位置。该方法的原理是通过分析俯仰率信号来提取车辆的振动和运动模式。然后，利用预先构建的索引地图进行模式匹配以进行位置估计。该技术没有累积误差，因此具有合理的精度（约5m）。然而缺点是它很容易受到测量噪声的影响[68]，[77]，[78]。

基于视觉的定位

基于视觉的定位通常可以达到合理的精度。多核CPU和GPU的普及及其强大的并行图像处理能力的提高缓解了此类定位方法的高计算复杂性带来的压力[79]，[80]。

参考文献[81]使用四个鱼眼摄像头、一张预先构建的地图和当前车辆位姿来检测自主停车场景中给定范围内的对称停车标记。然后，将检测结果作为方向标记，以与预先构建的地图匹配。该方法可以实现车辆定位，平行位置误差为0.3米，定位时间为0.04s。Du等人[82]开发了一种改进的序列RANSAC算法，以有效地从图像中提取车道线，用于特征匹配；在具有车道线的场景中，它们实现了大约0.06m的位置误差和0.12s的定位刷新率。参考文献[83]为特征匹配构建了基于道路地标的轻量级3D语义地图，然后最小化残余配准误差以估计车辆位置。该地图可以减少内存使用，这只会导致图像匹配的四次迭代。然而，这种方法的缺点是，当在弯道场景中使用时，仍需要进一步测试。其他相关算法[6]、[84]、[85]、[86]、[87]可以参考具体论文。

同时，参考文献[88]开发了一个拓扑模型，以从参考地图中获得一组接近捕获图像的可能节点。然后，他们将提取的整体特征与最近节点的可能节点进行匹配。最后通过将该节点的特征与图像中的局部特征相关联，以0.45m的位置精度实现了可靠的车辆定位。然而，这种方法受到照明灵敏度的影响，这可能导致定位失败。参考文献[89]提出了一种扩展的赫尔普查变换方法，用于从全方位图像数据集进行语义描述和特征提取，以构建拓扑图。通过结合基于内容和特征的图像检索方法进行场景识别，该工作通过将识别结果与拓扑图匹配，在变化的亮度和动态障碍场景中实现了约85.5%置信度的鲁棒定位。然而，这种技术的挑战在于其位置刷新周期长达2秒。

讨论

总之，基于无源传感器的定位技术的分析显示了获得低成本AV定位的显著优势。然而，需要注意的是，独立的无源传感器不能满足精度和鲁棒性要求。GPS经常受到城市中NLOS、多径或信号阻塞的影响，这对定位的一致性和完整性提出了挑战。通过融合来自不同来源的GPS测量、缺陷信号边界和地图辅助，可以改进基于GPS的定位。当GPS信号不可用时，DR系统可以提供实时一致的车辆位置。例如，如[9]所示，基于DR的IMM方法减少了系统漂移，提高了GPS中断或GPS信号模块环境中的定位鲁棒性和完整性。然而，基于GPS和基于IMU的定位仍然需要进一步提高GPS-IMU信号长期异常情况下的精度、一致性和完整性性能。基于视觉的定位可以实现0.14米的定位RMSE。但合理的定位时间通常要求系统配备GPU以加速。此外，相机在照明不足或恶劣天气（如雾和雨）条件下的可靠性仍需进一步研究。上述讨论表明，通过融合多个低成本传感器，数据融合技术将成为实现成本高效定位解决方案的趋势。同时，参考文献[90]–[93]中关于传感器故障检测和识别方法的最新研究表明，在提高定位鲁棒性方面具有显著优势，如基于IMM的故障识别方法、基于多模型和模糊逻辑的故障检测方法等。未来的研究需要集中于这些技术和缺陷数据建模方法。

5基于V2X的定位

基于V2V的定位

基于V2V的定位不要求车辆配备高精度传感器，以实现VANET下的精确位置。相反，它可以通过融合来自其他连接车辆的粗略位姿信息来实现合理的位置精度[94]。然而，其缺点是道路上参与车辆的分布不足或不均匀可能导致定位精度不足[95]，[96]。

Liu等人[15]提出了一种基于与其他车辆共享GPS伪距离测量值的加权最小二乘-双差法来计算车辆间距离。他们使用分布式位置估计算法来融合共享数据，实现了约4米的定位精度。该解决方案减少了随机噪声的影响，并提高了计算车辆间距离的准确性。参考文献[97]提出使用贝叶斯方法来融合来自其他车辆的目标车辆GPS位置和车辆间距离的GPS位置信息，以进行车辆定位。该方法可以显著降低定位不确定性。为了消除参与车辆需要预定义动态运动模型来实现数据融合的挑战，参考文献[98]计算了关于车辆当前位置的置信度，这是一种可以推断车辆位置并在VANET中传播的概率。然后，他们使用到达角度和TOA技术来测量车辆间距离，从而显示相邻车辆的相对位置。最后，通过计算相邻位置的权重和来估计车辆位置；位置包括相对位置和信念。该方法的位置精度约为1.95m，但刷新率高达1.4s（7辆车接入网络）。其他相关算法[99]-[103]可以参考具体论文。

基于V2X的定位

基于V2I的定位基于附近基础设施的位置推断车辆位置。它可以实现准确、实时和鲁棒的定位性能。V2I技术的优点包括基础设施的高精度定位、独立于时间的稳定数据源和低计算复杂性。

参考文献[104]和[105]提出了基于磁标记的V2I定位。首先，在道路上以一定的间隔布置具有独特高斯极阵分布的磁标记，并将每个标记的位置和分布存储在数据库中。然后，检测每个标记，并在车辆行驶过程中计算其高斯分布。最后，通过在数据库中搜索该分布来确定车辆位置。该方法将失真的影响降至最低，并达到厘米级（<10cm）的定位精度。RFID技术，包括低成本的RFID读取器和RFID标签也用于定位。RFID标签部署在路面上，配备有RFID读取器的车辆可以根据标签确定位置[106]，[107]。至于缺点，这些技术需要高密度的基础设施，并且容易受到基础设施堵塞的影响。其他相关算法[108]-[113]可以参考具体论文。

讨论

从V2X定位技术的回顾来看，V2V和V2I解决方案都不需要昂贵的专用硬件。对于基于V2V的解决方案，道路上参与车辆的充分和均匀分布可以提高定位精度和鲁棒性。然而，不断增加的车辆可能会导致较高的系统计算开销，但精度没有太大提高。用于在节点之间创建层次结构的高效集群架构可以在具有长距离的VANET下提供准确的V2V通信服务。通过对此类架构的进一步研究，可以克服车辆间准确信息交换的挑战。CMM方法可以提供一种潜在的方法来消除天线之间的多径误差，但传播信号延迟的问题仍然需要进一步解决。V2X系统的信号延迟建议在10ms内[3]。可以通过优化网络参数（例如，数据波特率、传播频率和天线功率等）来解决信号降级和丢包问题，之前的调查已经对此进行了详细讨论[8]。基于RFID的V2I系统可以实现成本高效的AV定位。然而，这些方法需要高密度的基础设施，并且容易受到基础设施堵塞的影响。基于RFID的技术非常适用于AV在固定路线上行驶的应用，例如动物园的观光巴士或港口的集装箱装卸车。优化RSU高度、传播角度和传输功率之间的关系可以确保信号强度和网络覆盖范围广，以实现基于RSU的V2I定位。尽管信号延迟仍需要进一步解决以提高定位精度。

6基于数据融合的定位

基于多传感器的数据融合定位

之前的讨论表明，没有独立的传感器能够满足AV定位的准确性、实时性和可靠性要求。多个传感器的数据融合显示出实现准确、实时和可靠的自我定位的巨大潜力。

参考文献[114]开发了一种交互式多模型（IMM）滤波器，该滤波器由车辆动力学模型和车辆运动学模型组成，以通过使用低成本传感器实现成本高效的AV定位。GPS数据和车内传感器（即车轮速度传感器和转向角传感器）数据用于该过滤器。IMM滤波器可以基于各种驾驶场景来权衡数据融合实现的适当模型。该方法可以在32位嵌入式处理器中实现合理的定位性能。参考文献[115]建议使用三个基于IMM的UKF构建模型，以融合低成本传感器数据，如GPS和惯性传感器。该模型减少了来自惯性传感器的大部分不确定噪声，预测并补偿了定位误差，并可以在GPS中断期间实现1.18米的位置精度。对于动态机动情况，如强加速、高速转弯以及启动和停止，Ndjeng等人[116]表明，使用低成本传感器（如IMU、里程计和GPS）的基于IMM的定位系统优于基于EKF的定位系统。他们通过实际实验得出结论，基于IMM的定位鲁棒性性能优于基于EKF的车辆动力学操纵的高可变性。其他相关算法[117]-[131]可以参考具体论文。

基于地图的数据融合定位

基于地图的数据融合技术基于多传感器测量，并通过添加地图信息来提高定位性能。例如，Suhr等人[132]提出将低成本传感器与数字地图融合，以提高实时性能。他们将车道和道路标记特征表示为一组关键点，并使用前视摄像头模块处理捕获的图像。该解决方案可以减少内存使用和计算开销；此外，其位置刷新率约为100Hz，位置精度约为0.5m。蔡等人[133]提出了一种数据驱动的运动模型，不使用惯性传感器来消除积分误差的挑战。他们通过使用高清地图校正了GPS位置和相机的横向距离，然后将这两种信息用作融合数据。与纯GPS定位相比，该方法的位置误差减少了1/3。Gruyer等人[134]，[135]提出了一种基于精确数字地图、GPS、IMU和两个相机的地图辅助数据融合方法，以获得亚分米精度的AV横向位置。他们首先通过两个侧面摄像头估计了车辆到车辆左右两侧道路标记的距离。然后，他们使用EKF通过GPS和IMU传感器测量来估计车辆位置。最后，他们将先前估计的车辆位置和通过基于点到线段的地图匹配算法获得的匹配线段位置相结合，以进一步提高定位精度和可靠性。其他相关算法[136]-[139]可以参考具体论文。

讨论

分析表明，基于低成本多传感器（如GPS、IMU、摄像头和里程计等）数据融合的技术可以为自动驾驶车辆提供一种经济高效的商业定位解决方案。融合GPS测量的多传感器数据融合技术仍然需要解决GPS完整性问题。基于IMM的融合方法可以减少来自惯性传感器的大部分不确定噪声，并在GPS中断或GPS信号阻塞期间提高定位精度和鲁棒性。然而，IMM的定位误差仍然达到米级。通过将缺陷数据建模为区间，区间方法可以实现具有高完整性和一致性的车辆定位。该方法的定位RSSE和更新时间可以分别为约15cm、约170ms。间隔技术可以为市场提供一种潜在的基于融合的定位解决方案。然而，在不同复杂环境中的整体定位性能仍需要进一步验证，以实现完全AVs。与地图融合的协作方法还可以获得准确和鲁棒的定位解决方案。例如，参考文献[136]显示了一种协作方法，该方法可以通过与多传感器（例如GPS、相机等）、SLAM和地图融合来增强定位精度和鲁棒性。此外，还可以关注不同传感器的故障检测和识别技术，以确保更稳健的AV定位。综上所述，上述讨论表明，基于数据融合的技术具有在经济性、实时性、准确性和鲁棒性之间权衡商用自动驾驶车辆定位性能的巨大潜力。

7精度和实时性能讨论

定位性能评估的相关工作

实时、准确和稳健的AV定位是确保安全驾驶的关键要素之一。不同定位技术的性能比较可以指导AV系统的传感器选择和研究目的。已经发表了许多与不同定位算法的准确性和鲁棒性性能比较相关的工作。Zhang等人[138]从理论上分析了RI-EKF-SLAM的收敛性和一致性，并将其定位性能与SO（3）-EKF-SLAM进行了比较。Zhang等人通过一维、二维和三维模拟比较了基于RI-EKF的SLAM和基于优化的SLAM的准确性和一致性性能。[140]。此外，Mourllion等人[141]在车辆定位的预测步骤中展示了卡尔曼滤波器变量的性能，例如EKF、UKF以及一阶和二阶的除法差（DD1和DD2）。Gruyer等人[142]使用基于精度和滤波器不确定性和一致性的标准以及多传感器实验测量，比较了这些KF变体的整体定位过程（预测和校正步骤）。Ndjeng等人[116]评估了动态机动场景下基于IMM和基于EKF的低成本定位系统的准确性和鲁棒性性能。到目前为止，很少有工作对定位实时性能进行了比较。参考文献[6]和[149]比较了基于CPU和GPU平台的同一解决方案的定位时间。参考文献[143]在CPU和GPU上运行滤波算法，以比较它们的执行时间。然而，上述实时性能比较仅在各种平台上运行相同的算法。在各种硬件平台和编程语言上展示了不同定位解决方案的实时性能。此外，整个解决方案的定位时间受数据提取和原始搜索步骤、核心定位算法执行、地图存储和更新（如果使用了地图）的影响。为了在没有实际测试的情况下对不同解决方案进行快速实时性能比较，首先，论文假设不同研究论文中显示的定位时间与完整的定位解决方案有关，而不仅仅是算法。其次假设每个解决方案中运行的代码都充分利用了所有计算源。因此，基于不同的硬件计算能力和编程语言执行效率，可以将不同解决方案的本地化时间转换为相同的基准。然后，可以近似地和定量地比较不同解决方案的实时性能。

等效比较法

对不同定位技术的讨论表明，AV定位主要依赖CPU和GPU作为硬件平台，MATLAB和C/C++作为编程语言。众所周知，不同的硬件具有不同的计算能力。例如，当使用滤波算法处理激光雷达3D点云数据时，GPU比CPU快52倍[143]。对于编程语言来说，C/C++是一种编译语言，在执行之前被翻译成机器语言。MATLAB是一种解释语言，其中每行代码都必须在执行期间由解释器读取和解释，这使得它比编译语言要慢得多[144]，[145]。因此，在比较不同定位技术的实时性能时，必须考虑使用硬件和编程语言的因素。

作为第一步，必须确定CPU/GPU系列之间以及CPU和GPU之间的定位算法操作能力（LAOC）等效转换系数。CPU/GPU系列中的所有CPU/GPU都源自不同定位技术的硬件平台。在本文中，使用单精度浮点（SPFP）峰值性能来确定GPU/CPU系列的LAOC等效转换关系，因为定位算法通常涉及SPFP操作。在CPU系列中，SPEC CPU®2006基准测试[146]旨在比较不同CPU在硬件级别的计算密集型性能。这取决于处理器、内存结构和总线的因素。该基准可以全面评估和比较不同CPU的硬件性能[147]。因此，CPU系列之间的LAOC等效转换关系基于SPECfp2006[148]，其中给出了每秒CPU相对峰值浮点运算（FLOPS）性能。对于标准化，本文所示相对峰值FLOPS性能的最小值作为基线，其LAOC等效转换系数确定为。CPU系列之间的LAOC等效转换系数通过使用，如表III所示。

对于GPU系列，影响FLOPS功能的因素包括频率f、内核数量N和每个内核FMA的每个周期的单精度融合乘加运算（FMA）。FMA可以在所选GPU的官方网站中找到。理论上的单精度峰值性能可以通过使用以下方程来估计。

对于相同的数据传输和复制，可以表示GPU的实际SPFP计算能力，GPU系列之间的转换关系基于。对于归一化，论文将本文中给出的最小FLOPS峰值性能定义为基线，其LAOC等效转换因子为。GPU系列之间的LAOC等效转化因子通过使用a计算，如表IV所示：

对于CPU和GPU之间的LAOC等效关系，Charmette等人[6]，[149]在比较定位应用中的CPU和GPU计算性能方面进行了许多有代表性的工作。在本文中，CPU和GPU之间的转换因子基于他们的最新研究结论[6]。结论表明，同一种方法GPU的定位时间大约是CPU的45倍。作者提到，双核CPU中只有一个内核用于定位。因此，论文认为[6]中CPU的峰值FLOPS性能是相同双核CPU的一半，如表III所示。[6]中CPU和GPU之间的LAOC等效转换系数确定为。

论文考虑将C/C++作为编程语言基准，其LAOC等效转换因子设置为。MATLAB设置为。

最后论文选择基准峰值FLOPS性能作为硬件基准，选择C/C++作为编程语言基准。基于不同硬件和编程语言的定位时间必须转移到此基准进行比较。转换方法由以下等式给出。

方法验证

在本文中，参考文献[29]用于评估所提出的基于LAOC的等效比较方法。参考文献[29]比较了基于CPU和GPU平台的相同解决方案的定位时间。CPU和GPU的TR和TC、硬件和软件的LAOC等效转换因子h和s分别列于表V中。表V显示，转换前定位时间的差异是由于硬件平台（CPU和GPU）不同造成的。转换后的定位时间大大增加，因为硬件基准的峰值FLOPS性能最低，编程语言也相同。此外，转换结果表明，，这意味着转换后基于CPU和GPU的定位时间相似。这是因为解决方案A和解决方案B都是相同的解决方案，但在不同的硬件平台中实现。因此，基于LAOC的等效比较方法是合理的，可以用于近似和定量地比较不同的定位解决方案。表VI总结了使用方程（2）计算的不同定位技术的相对计算复杂性。

讨论

1）准确度和实时性能：本节定量比较了上述所有定位技术的计算复杂性和位置误差。图2显示，在基于激光雷达的定位中，基于3D地图的方法在精度方面优于基于2D地图的方法，因为它包含丰富的特征信息。然而，基于3D地图的技术增加了内存使用量和计算负载，导致算法的计算复杂度较高。此外，尽管基于2D地图的技术之间的精度差异较小，但由于不同的方法，计算复杂性差异很大。例如，[29]中的2D GMM匹配技术的计算复杂度约为[42]中多层RANSAC配准和2D地图匹配方法的组合的2000倍。与基于激光雷达的定位技术相比，基于雷达和超声波的定位技术具有更低的计算复杂性，因为它们发射低密度电磁波。雷达定位的计算复杂性和位置误差介于激光雷达和超声波定位之间；尽管粒子群优化和网格地图匹配方法相结合实现了合理的定位性能，但该方法需要严格的传感器部署。由于超声波传感器的低精度，基于超声波的技术位置精度的位置精度约为10m。

图3显示，对于开阔天空中的纯GPS定位，GPS接收机可以输出频率为1Hz、精度为2–10m的位置信息，而不受车辆操作系统的限制。与其他基于传感器的定位相比，基于IMU的技术由于其快速的位置刷新率，可以实现最低的计算复杂度，但其累积误差仅在10分钟的驾驶时间内导致约1m的定位误差。在基于视觉的定位方面，图像中包含的丰富环境信息使其计算复杂性与基于激光雷达的方法相似。然而，由于图像质量和镜头失真的挑战，视觉无法准确测量周围物体的范围。因此，其定位精度低于基于激光雷达的技术。此外，它的计算复杂度随着参考地图的维数而降低，但其位置精度变化不大。

如图4所示，与基于激光雷达和视觉的定位相比，基于V2X的定位的实时性能更好，但由于信号延迟或参与节点不足的挑战，其精度不令人满意。

图5显示，与其他基于传感器的定位相比，基于数据融合的技术可以在精度和实时性能方面实现平衡。这是因为它利用每个传感器的优点来减少其他传感器缺点的影响，并且每个独立传感器不需要开发复杂的算法来实现其最佳定位潜力。

总之，不同的基于传感器的定位技术的计算复杂性最大相差约10^7倍，而位置误差相差约100倍。表VII总结了不同传感器技术在精度和实时性能方面的性能。

2）应用场景：满足AV应用安全驾驶要求的精度和实时性能分别是位置误差和位置输出频率，要求分别小于30cm[3]和100ms[151]。分析表明，基于激光雷达、视觉和数据融合的定位具有满足精度性能的潜力。基于激光雷达和视觉的技术使用强大的处理器，如高性能GPU和多核CPU，可以满足实时性能要求。基于数据融合的技术融合多个低成本传感器（例如，相机、GPS、IMU和车载传感器）的计算复杂性低于基于激光雷达和视觉的技术。总之，融合技术在实现经济高效的自主定位方面具有相当大的潜力。

此外，表VII还可以指导不同场景下的定位解决方案选择。对于行人和车辆高度参与交通的城市环境，与其他常见驾驶环境相比，定位精度和实时要求最高。尽管基于激光雷达、视觉和基于激光雷达或视觉的数据融合技术可能会增加硬件部署成本以实现实时性能，但这些技术可以获得精确的定位精度。高速公路和郊区场景中，AV周围的行人和车辆较少。这些场景中的精度要求可能低于城市环境中的精度。然而，AVs需要远距离检测传感器来感知周围的障碍物和高频位置输出，以满足高速驾驶。因此，具有远距离传感器感知和实时性能的定位技术可能是一种潜在的选择，例如基于数据融合、雷达和V2V的技术。由于专用车道上的障碍物较少，且用作城市巴士或观光巴士的AVs行驶速度较低，因此准确度和实时性要求低于上述情况。在这种情况下，低成本的数据融合、V2I和基于雷达的定位技术可能是首选方案。在自动停车场景中，检测距离和定位实时性能不需要像上述应用中那样高。因此，低成本的超声波和雷达技术可能是最有前途的选择。

8结论

本文综述了基于主动传感器、被动传感器、V2X和数据融合的最新自定位技术，并定量比较了它们的精度和计算复杂性性能。与1D地图和3D地图匹配方法相比，基于激光雷达的2D地图匹配方法显示了在成本、准确性、实时性和鲁棒性之间平衡商用AVs定位性能的最重要前景。然而，基于激光雷达的定位比其他基于传感器的定位（如基于雷达的定位、基于视觉的定位和基于V2X的定位）更昂贵。此外，基于激光雷达的（2D）解决方案的实时性能可能受到系统计算能力的限制，并且需要强大的CPU/GPU加速，这会增加AV的部署成本。需要进一步改进基于激光雷达的（2D）解决方案，以使用低成本处理器缩短定位更新时间。基于无源传感器的定位解决方案在部署成本低方面显示出显著优势。挑战在于，对于典型的无源传感器，例如基于GPS的传感器和IMU，定位的完整性和一致性使得该技术仍然难以应用于AV。基于视觉的定位可以实现高精度的车辆位置，但可能需要GPU加速来处理大量图像数据。相机在照明不足或恶劣天气下的可靠性也需要进一步解决。V2X技术可以在VANET的广泛信号强度和网络覆盖范围内提供成本高效的AV定位解决方案。基于RFID的技术非常适合固定路线的AV应用，例如动物园的观光巴士、港口的集装箱装卸车。然而，V2X系统中的信号延迟和数据包丢失问题需要进一步优化，以提高定位精度和一致性。与其他基于传感器的定位解决方案相比，基于数据融合的技术在权衡商用AV的经济性、实时性、准确性和鲁棒性的定位性能方面具有最大的潜力。例如，基于区间理论的技术可以通过融合低成本传感器数据（例如GPS、IMU和里程计）来实现具有高完整性和一致性的车辆定位。在商业化之前，在不同的变化环境和各种驾驶条件（如长途驾驶）下对该技术进行进一步研究和验证至关重要。

此外，实时性和准确性性能之间的比较分析表明，不同基于传感器的定位技术的位置误差最大相差约100倍。基于激光雷达、视觉和数据融合的定位技术有可能满足AV安全驾驶的精度要求（小于30cm）。与其他基于传感器的技术相比，基于激光雷达的技术实现了最佳的定位精度，并且不同基于激光雷达方法实现的位置精度相似。此外，高维地图匹配或基于强度的匹配方法可以将位置误差减少约2-3倍，但可以将计算复杂性增加约20-2000倍。与基于激光雷达的定位相比，基于视觉和数据融合的定位在提高位置精度方面的潜力约为2–5倍。就实时性能而言，不同基于传感器的技术之间的计算复杂度最大变化约10^7倍。与精度相比，它有很大的改进空间。IMU、超声波、多传感器融合和基于雷达的自定位可以通过低成本处理器满足安全驾驶的实时性能要求（<100ms），而基于激光雷达和视觉的定位可以通过使用强大的处理器实现实时定位。然而，基于IMU、超声波和雷达的技术定位精度不足，通常被用作AV中的辅助定位解决方案。与不同的方法相比，基于激光雷达的技术具有最高的计算复杂性和大约2000倍的最大差异。重点改进激光雷达图像配准方法可以提高基于激光雷达的技术的实时定位性能。基于视觉的定位的计算复杂性与基于激光雷达的方法相似，与不同方法相比，其最大差异约为1000倍。提高捕获图像关联的效率和准确性可以提高准确性和实时性能。此外，匹配低维特征可以降低计算复杂性，但对精度没有实质性影响。与基于激光雷达和视觉的定位相比，基于数据融合的定位实现了更好的实时性能，因为每个独立传感器不需要开发复杂的算法来实现其最佳定位潜力。此外，它实现了准确度和实时性能之间的最佳平衡。总之，基于激光雷达、视觉和数据融合的技术在实时性能方面仍有很大提高。

讨论表明，没有一个传感器能够满足自动驾驶的所有定位要求。与其他基于单一传感器的技术相比，基于数据融合的技术将是实现AV成本高效自定位的研究重点。除了传统的融合信息源，如GPS和IMU，V2X将是一个有前途的解决方案，主要原因是它对光照和天气具有出色的鲁棒性。它具有广泛的检测范围（约300m），可以增加数据源并提高其稳定性。然而，精度、实时性能和鲁棒性之间的权衡仍需进一步研究。此外，未来的研究需要集中于传感器故障检测和识别技术以及缺陷数据建模方法，以确保稳健和一致的AV定位。随着新的新兴方法的兴起，如机器学习和深度学习。基于地图的定位性能可以得到增强，因为人工智能算法具有自动学习特征的巨大潜力。我们让读者参考Fayyad等人最近的调查[152]，该调查对基于深度学习的定位进行了全面综述。

9参考

[1] Real-Time Performance-Focused Localization Techniques for Autonomous Vehicle: A Review

往期回顾

史上最全综述 | 3D目标检测算法汇总！（单目/双目/LiDAR/多模态/时序/半弱自监督）

【知识星球】日常干货分享

【自动驾驶之心】全栈技术交流群

自动驾驶之心是首个自动驾驶开发者社区，聚焦目标检测、语义分割、全景分割、实例分割、关键点检测、车道线、目标跟踪、3D目标检测、BEV感知、多传感器融合、SLAM、光流估计、深度估计、轨迹预测、高精地图、规划控制、模型部署落地、自动驾驶仿真测试、硬件配置、AI求职交流等方向；

添加汽车人助理微信邀请入群

备注：学校/公司+方向+昵称

自动驾驶之心【知识星球】

想要了解更多自动驾驶感知（分类、检测、分割、关键点、车道线、3D目标检测、多传感器融合、目标跟踪、光流估计、轨迹预测）、自动驾驶定位建图（SLAM、高精地图）、自动驾驶规划控制、领域技术方案、AI模型部署落地实战、行业动态、岗位发布，欢迎扫描下方二维码，加入自动驾驶之心知识星球（三天内无条件退款），日常分享论文+代码，这里汇聚行业和学术界大佬，前沿技术方向尽在掌握中，期待交流！