智能网联汽车技术：第4章 智能网联汽车导航定位技术

1、 第 1 页第4章 智能网联汽车导航定位技术4.1 导航定位的定义与类型4.2 全球卫星定位技术4.3 北斗卫星导航定位系统4.4 惯性导航系统4.5 通信基站定位4.6 即时定位与地图构建（SLAM）技术4.7 电子地图技术 第 2 页第4章 智能网联汽车导航定位技术 第 3 页第4章 智能网联汽车导航定位技术 第 4 页4.1 导航定位的定义与类型定义导航定位是负责实时提供智能网联汽车的运动信息，包括位置、速度、姿态、加速度、角速度等，一般采用的是多传感器融合定位的方式。智能网联汽车的导航定位通过全球卫星定位系统（GPS）、北斗卫星导航定位系统（BDS）、惯性导航系统、视觉SLAM、激光雷

2、达SLAM等，获取车辆的位置和航向信息。 第 5 页4.1.1 导航定位的定义绝对定位：是指通过GPS或BDS实现，采用双天线，通过卫星获得车辆在地球上的绝对位置和航向信息相对定位：是指根据车辆的初始位姿，通过惯性导航获得车辆的加速度和角加速度信息，将其对时间进行积分，得到相对初始位姿的当前位姿信息组合定位：是将绝对定位和相对定位进行结合，以弥补单一定位方式的不足 第 6 页4.1.1 导航定位的定义L1、L2级，仅需要实现ADAS，导航级精度即可L3L5级，实现自动驾驶，需要厘米级精度导航智能网联汽车的导航定位技术主要有全球卫星定位系统（GPS）、北斗卫星导航定位系统（BDS）、惯性导航系统

3、（INS）、通信基站定位、视觉SLAM定位、激光SLAM定位和高精度地图定位等4.1.2 全球导航卫星系统的类型美国的全球定位系统（GPS）、中国的北斗卫星导航定位系统（BDS）、俄罗斯的格洛纳斯（GLONASS）卫星定位系统以及欧洲空间局的伽利略（GALILEO）卫星定位系统2022/8/254.2 全球卫星定位技术全球卫星定位系统（GPS）是由美国国防部建设的基于卫星的无线电导航定位系统。它能连续为世界各地的陆海空用户提供精确的位置、速度和时间信息，最大优势是覆盖全球，全天候工作，可以为高动态、高精度平台服务，目前得到普遍应用2022/8/254.2.1 全球卫星定位系统组成卫星：大约有3

4、0颗GPS卫星、约2万千米在太空运行地面监控设备：分散在世界各地，用于监视和控制卫星，其主要目的是让系统保持运行，并验证GPS广播信号的精确度GPS用户：由GPS接收机和GPS数据处理软件组成。2022/8/254.2.1 全球卫星定位系统工作原理GPS定位时要求接收机至少观测到4颗卫星的距离观测值才能同时确定出用户所在空间位置及接收机时钟差2022/8/254.2.1 全球卫星定位系统特点（1）全球全天候定位：因为GPS卫星数目较多，且分布均匀，保证了地球上任何地方任何时间至少可以同时观测到4颗GPS卫星，确保实现全球全天候连续导航定位服务（2）覆盖范围广：能够覆盖全球98%的范围，可满足位

5、于全球各地或近地空间的军事用户连续精确地确定三维位置、三维运动状态和时间的需要（3）定位精度高：GPS相对定位精度在50km以内可达610m，100500km可达710m，1000km可达910m2022/8/254.2.1 全球卫星定位系统特点（4）观测时间短：20km以内的相对静态定位仅需1520min；快速静态相对定位测量时，当每个流动站与基准站相距15km以内时，流动站观测时间只需12min；采取实时动态定位模式时，每站观测仅需几秒钟（5）全球统一的三维地心坐标：同时精确测定测站平面位置和大地高程（6）测站之间无需通视：只要求测站上空开阔，可省去经典测量中的传算点、过渡点等的测量工作2

6、022/8/254.4.2 差分全球定位系统差分全球定位系统（DGPS）是在GPS的基础上利用差分技术使用户能够从GPS系统中获得更高的精度；由基准站、数据传输设备和移动站组成2022/8/254.4.2 差分全球定位系统位置差分安装在基准站上的GPS接收机观测4颗卫星后便可进行三维定位，解算出基准站的观测坐标由于存在着轨道误差、时钟误差、大气影响、多径效应以及其他误差等，解算出的观测坐标与基准站的已知坐标是不一样的，存在误差将已知坐标与观测坐标之差作为位置改正数，通过基准站的数据传输设备发送出去，由移动站接收，并且对其解算的移动站坐标进行改正位置差分法适用于用户与基准站间距离在100km以内

7、的情况2022/8/254.2.2 差分全球定位系统伪距差分利用基准站已知坐标和卫星星历可计算出基准站与卫星之间的计算距离，将计算距离与观测距离之差作为改正数，发送给移动站，移动站利用此改正数来改正测量的伪距。最后，用户利用改正后的伪距来解出本身的位置，就可消去公共误差，提高定位精度伪距差分能将两站公共误差抵消，但随着用户到基准站距离的增加，又出现了系统误差，这种误差用任何差分法都是不能消除的；用户和基准站之间的距离对精度有决定性影响2022/8/254.2.2 差分全球定位系统载波相位差分载波相位差分（RTK）技术是建立在实时处理两个测站的载波相位基础上的，它能够实时地提供测站点在指定坐标系

8、中的三维定位结果，并达到厘米级精度在RTK作业模式下，基站采集卫星数据，并通过数据链将其观测值和站点坐标信息一起传送给移动站，而移动站通过对所采集到的卫星数据和接收到的数据链进行实时载波相位差分处理（历时不足1s），得出厘米级的定位结果2022/8/254.2.3 GPS/DR组合导航定位系统车辆航位推算（DR）方法是一种常用的自主式车辆定位技术，它不用发射接收信号，不受电磁波影响，机动灵活，只要车辆能达到的地方都能定位DR是利用载体上某一时刻的位置，根据航向和速度信息，推算得到当前时刻的位置，即根据实测的汽车行驶距离和航向计算其位置和行驶轨迹。它一般不受外界环境影响，但由于其本身误差是随时间

9、积累的，单独工作时不能长时间保持高精度2022/8/254.2.3 GPS/DR组合导航定位系统2022/8/254.2.3 GPS/DR组合导航定位系统GPS/DR组合导航定位系统由GPS以及电子罗盘、里程计和导航计算机等组成2022/8/254.2.3 GPS/DR组合导航定位系统关键在于如何将两者的数据融合，以达到最优的定位效果将GPS和DR的定位信息综合用于定位求解，通过卡尔曼滤波来补偿修正DR系统的状态，同时滤波之后的输出又能够为DR系统提供较为准确的初始位置和航向角，从而能够获得比单独使用任意一种定位方法都更高的定位精度和稳定性2022/8/254.3 北斗卫星导航定位系统北斗卫星

10、导航定位系统（BDS）：是由中国自行研制开发的区域性有源三维卫星定位与通信系统，是继美国的GPS、俄罗斯的GLONASS之后第三个成熟的卫星导航定位系统。北斗卫星导航定位系统致力于向全球用户提供高质量的定位、导航和授时服务，其建设与发展则遵循开放性、自主性、兼容性、渐进性这4项原则。2022/8/254.3.1 北斗卫星导航定位系统的组成2022/8/254.3.2 北斗卫星导航定位系统的特点（1）空间段采用三种轨道卫星组成的混合星座，与其他卫星导航系统相比，高轨卫星更多，抗遮挡能力强，尤其在低纬度地区性能优势更为明显。（2）提供多个频点的导航信号，能够通过多频信号组合使用等方式提高服务精度。

11、（3）创新融合了导航与通信功能，具备定位导航授时、星基增强、地基增强、精密单点定位、 短报文通信和国际搜救等多种服务能力。2022/8/254.4 惯性导航系统定义惯性导航系统（INS）是一种利用惯性传感器测量载体的角速度信息，并结合给定的初始条件实时推算速度、位置、姿态等参数的自主式导航系统。具体来说，惯性导航系统属于一种推算导航方式。即从一已知点的位置根据连续测得的运动载体航向角和速度推算出其下一点的位置，因而可连续测出运动体的当前位置。2022/8/254.4.1 惯性导航系统的定义惯性导航系统一般采用加速度传感器和陀螺仪传感器来测量载体参数2022/8/254.4.1 惯性导航系统的定

12、义加速度传感器和陀螺仪结合是就是惯性测量单元（IMU），一个解决速度，一个解决方向。IMU 的一个重要特征在于它以高频率更新，其频率可达到1000Hz，所以 IMU 可以提供接近实时的位置信息惯性导航系统可以看成是IMU与软件的结合。通过内置的微处理器，能够以最高200Hz的频率输出实时的高精度三维位置、速度、姿态信息2022/8/254.4.2 惯性导航系统的作用弥补GPS：在GPS信号丢失或者很弱情况下，暂时填补GPS留下的空缺，用积分法取得最接近真实的三维高精度定位配合激光雷达：GPS+IMU为激光雷达的空间位置和脉冲发射姿态提供高精度定位，建立激光雷达云点的三维坐标系2022/8/25

13、4.4.2 惯性导航系统的特点优点（1）由于它是不依赖于任何外部信息，也不向外部辐射能量的自主式导航系统，故隐蔽性好，也不受外界电磁干扰影响（2）可全天候在全球任何地点工作（3）能提供位置、速度、航向和姿态角数据，所产生的导航信息连续性好而且噪声低（4）数据更新率高，短期精度和稳定性好2022/8/254.4.2 惯性导航系统的特点缺点（1）由于导航信息经过积分而产生，定位误差随时间而增大，长期精度差（2）每次使用之前需要较长的初始对准时间（3）不能给出时间信息2022/8/254.5 通信基站定位基站作为移动通信网络不可缺少的网元，是移动终端与移动网络之间交互的重要组成部分。随着移动通信网络

14、的迅速发展，更多的移动终端接入到移动通信网络中，越来越多的基站被建立起来，几乎遍布世界的每一个角落，为终端用户提供通信服务。所以移动通信网络中最基本的定位技术就是基于基站的定位技术常用的无线定位技术包括到达角（AOA）定位法、到达时间（TOA）定位法、到达时间差（TDOA）定位法等。2022/8/254.5.1 AOA定位法AOA定位方法也称方位测量定位方法，是由两个或多个基站接收到移动台的角度信息，然后对其计算移动台的位置2022/8/254.5.2 TOA定位法TOA是基于时间的定位方法，称为圆周定位。它通过测量两点间电波传播时间来计算移动台的位置。如果能够获取三个以上基站到移动台的传播时

15、间，就能得出移动台的位置2022/8/254.5.3 TDOA定位法TDOA定位也称双曲线定位，它是利用移动台到达不同基站的时间不同，获取到达各个基站的时间差，建立方程组，求解移动台位置2022/8/254.6 即时定位与地图构建（SLAM）技术SLAM中文译作“即时定位与地图构建”。它是指搭载特定传感器的主体，在没有环境先验信息的情况下，于运动过程中建立环境的模型，同时估计自己的运动。如果这里的传感器为相机，则为“视觉SLAM”；如果传感器为激光雷达，则为“激光SLAM”。2022/8/254.6 .1 视觉SLAM技术分类视觉SLAM分为单目、双目、深度相机（RGB-D）2022/8/25

16、4.6 .2 视觉SLAM技术特点2022/8/254.6 .1 视觉SLAM技术框架视觉SLAM分为单目、双目、深度相机（RGB-D）2022/8/254.6 .1 视觉SLAM技术框架（2）视觉里程计，又称为前端，能够通过相邻帧间的图像估计相机运动，并恢复场景的空间结构。被称为里程计是因为它只计算相邻时刻的运动，而和再往前的过去信息没有关联。相邻时刻运动串联起来，就构成了无人车的运动轨迹，从而解决了定位问题。另一方面，根据每一时刻的相机位置，计算出各像素对应的空间点的位置，就得到了地图。2022/8/254.6 .1 视觉SLAM技术框架（3）后端非线性优化，主要是处理SLAM过程中噪声的

17、问题。任何传感器都有噪声，所以，除了要处理“如何从图像中估计出相机运动”，还要关心这个估计带有多大的噪声。前端给后端提供待优化的数据，以及这些数据的初始值，而后端负责整体的优化过程，得到全局一致的轨迹和地图。它往往面对的只有数据，不必关心这些数据来自哪里。在视觉SLAM中，前端主要研究图像的特征提取与匹配等，后端则主要是滤波和非线性优化算法。2022/8/254.6 .1 视觉SLAM技术框架（4）回环检测，是指无人车识别曾到达场景的能力。如果检测到回环，它会把信息提供给后端进行处理。回环检测实质上是一种检测观测数据相似性的算法。对于视觉SLAM，多数系统采用目前较为成熟的词袋模型。词袋模型把

18、图像中的视觉特征聚类，然后建立词典，进而寻找每个图中含有哪些“单词”。也有研究者使用传统模式识别的方法，把回环检测建构成一个分类问题，训练分类器进行分类。2022/8/254.6 .1 视觉SLAM技术框架（5）建图。建图主要是根据估计的轨迹，建立与任务要求对应的地图。地图是对环境的描述，但这个描述并不是固定的，需要视SLAM的应用而定。地图的表示主要有2D栅格地图、2D拓扑地图、3D点云地图和3D网格地图2022/8/254.6 .1 视觉SLAM技术建图2022/8/254.6 .2 激光SLAM技术定义激光SLAM就是根据一帧帧连续运动的点云数据，从中推断出激光雷达自身的运动以及周围环境

19、的情况。激光SLAM根据其所用的激光雷达的线束不同可细分为2D-激光SLAM和3D-激光SLAM。2022/8/254.6 .2 激光SLAM技术特点激光SLAM具有能够准确测量环境中目标点的角度与距离、无需预先布置场景、可融合多传感器、能在光线较差环境中工作、能够生成便于导航的环境地图等特点，成为目前定位方案中不可或缺的新技术。在SLAM过程中，无人车通过激光雷达感知周围环境，并对周围环境进行重建，然后通过观测数据计算无车人当前的位姿，并融合无人车内部里程计、加速度计等传感器推算得到的位姿改变，以此对无人车进行精准的定位。2022/8/254.6 .2 激光SLAM技术框架2022/8/25

20、4.6 .3 视觉SLAM与激光SLAM的区别1.成本激光雷达普遍价格较高，而视觉SLAM主要是通过摄像头来采集数据信息，跟激光雷达一对比，摄像头的成本显然要低很多。但激光雷达能更高精度的测出障碍点的角度和距离，方便定位导航。2.应用场景视觉SLAM的应用场景要丰富很多，在室内外环境下均能开展工作，但是对光的依赖程度高，在暗处或者一些无纹理区域是无法进行工作的。而激光SLAM目前主要被应用在室内，用来进行地图构建和导航工作。2022/8/254.6 .3 视觉SLAM与激光SLAM的区别3.地图精度激光SLAM构建的地图精度比视觉SLAM高，且能直接用于定位导航。4.易用性激光SLAM是通过直

21、接获取环境中的点云数据，根据生成的点云数据，测算哪里有障碍物以及障碍物的距离。但是基于单目、双目和鱼眼摄像机的视觉SLAM方案，则不能直接获得环境中的点云，而是形成灰色或彩色图像，需要通过不断移动自身的位置，通过提取和匹配特征点，利用三角测距的方法测算出障碍物的距离。2022/8/254.6 .4 激光SLAM技术的应用2022/8/254.7 电子地图技术导航电子地图导航电子地图以GPS导航设备为依托，融入计算机技术、地理信息系统（GIS）技术、三维（3D）技术，以数字方式存储和查阅，可进行地理信息定位显示、索引、计算、引导，主要用于路径规划和导航2022/8/254.7.1 导航电子地图作

22、用（1）定位显示。（2）路径规划。（3）路线索引。（4）信息查询。2022/8/254.7.1 导航电子地图特点（1）支持导航区域的相对无限性，覆盖范围足够广（2）高精度，多尺寸。（3）以路网为主，合理准确地表达空间关系。（4）支持实时，动态的快速显示。（5）现实性好，更新周期短。2022/8/254.7.2 高精度地图定义高精度地图就是精度更高、数据维度更多的电子地图。精度更高体现在精确到厘米级别，数据维度包括道路数据，比如车道线的位置、类型、宽度、坡度和曲率等车道信息；车道周边的固定对象信息，比如交通标志、交通信号灯等信息，车道限高、下水道口、障碍物及其他道路细节，防护栏、道路边缘类型、路边地标等基础设施信息。2022/8/25高精度地图与导航地图的区别（1）使用对象。导航电子地图的使用者是驾驶员，有显示；高精度地图的使用者是自动驾驶系统，无显示。（2）精度。导航电子地图的精度在米级别，商用GPS精度为5m；高精度地图的精度在厘米级别，可以达到1020cm级别。（3）数据维度。导航电子地图数据只记录道路级别的数据：道路形状、坡度、曲率、铺设、方向等；高精度地图不仅增加了车道