一种基于同步定位构图的车辆组合定位方法与流程

本发明属于无人驾驶汽车组合定位方法领域，具体涉及一种基于同步定位构图的车辆组合定位方法。

背景技术：

无人驾驶汽车作为汽车发展的主要发展方向之一，其在人类未来生活中发挥的作用将越来越重要，随之而来的无人驾驶汽车的定位问题也越来越受到人们的关注。由于汽车行驶的环境比较复杂，难以靠单独一种传感器来得到车辆的准确定位，倘若车辆的定位不准，那么对于车辆的路径规划和导航都会造成重大的影响。因此，研制一种能在车辆行驶过程中提高无人驾驶汽车可定位性的系统，必然能够提高车辆定位的准确性，增加适应复杂环境的鲁棒性，对无人驾驶汽车的技术发展及普及应用都有重要的价值。

目前提高车辆定位的技术，按照行驶环境的不同分为室内定位和室外定位。室内定位主要是使用基于激光雷达传感器和相机的激光slam和视觉slam技术，激光雷达传感器定位精度好，但是多线激光雷达成本太高，难以进行大规模应用；相机成本低，但是图像处理时运算量大，需要进行不断的优化。若slam技术用于室外，在空旷或者特征点少的室外环境下，容易出现绑架问题，车辆会丢失自己的定位。室外定位大多使用差分gps得到车辆的绝对坐标，但是室外环境复杂，gps信号容易受到周围环境的遮挡和电磁信号的干扰，因此gps提供的定位坐标不稳定，误差相差很大，现行的室外定位更多是将gps信号与imu、里程计信息进行数据融合得到车辆较准确的定位，但在长时间运行之后误差会增大，且定位精度不够精确，难以达到无人驾驶汽车的定位要求。

技术实现要素：

本发明的目的在于克服上述不足，提供一种基于同步定位构图的车辆组合定位方法，能够提高车辆的可定位性，增加车辆定位的精度与鲁棒性。

为了达到上述目的，本发明包括以下步骤：

步骤一，通过移动站模块得到车辆移动过程中的实时经纬度坐标信息，通过基站模块获得伪距修正量；

步骤二，通过gps坐标转换模块将实时经纬度坐标信息转换为地图坐标系下的坐标，并计算gps在不同锁星数不同工作环境下的协方差矩阵；

步骤三，结合伪距修正量对协方差矩阵进行修正，得到车辆的绝对定位坐标；

步骤四，通过激光slam定位模块感知车辆行驶环境，实时得到车辆相对坐标，通过can总线采集速度转角信息，得到行驶里程，根据行驶里程和实时相对坐标与现有地图进行实时扫描匹配，生成增量式地图，并在增量式地图上记录车辆行驶的相对坐标信息；

步骤五，根据车辆的绝对定位坐标和相对坐标信息，运用无损卡尔曼滤波算法进行融合，得到车辆最终的定位信息。

步骤一中，基站模块通过3g/4g无线网络通讯格式对数据进行收发。

步骤二中，gps坐标转换模块接收到实时经纬度坐标信息后，首先经过高斯-克吕格投影，得到投影后的utm坐标系下坐标信息，之后将投影后的utm坐标系下坐标信息与车辆在地图坐标系下的坐标进行平移旋转变换，得到gps坐标在地图坐标系下的坐标。

步骤二中，协方差矩阵通过以下方法获得：

利用gps在不同环境下的锁星数和在该锁星数下的经纬度变化信息，得到在该锁星数时的协方差矩阵；

在不同的环境下进行测量，将锁星数进行阈值划分，相隔两个锁星为一个协方差矩阵，得到不同环境不同锁星数时协方差矩阵；

当gps接收到经纬度信息和锁星数时，将该锁星数对应的协方差矩阵作为实时的协方差矩阵。

步骤四中，激光slam定位模块采用单线激光雷达。

步骤四中，增量式地图为二维栅格地图。

步骤五中，无损卡尔曼滤波算法的预测值为车辆的绝对定位坐标，无损卡尔曼滤波算法的测量值为车辆行驶的相对坐标信息。

与现有技术相比，本发明能够实时得到移动站模块所提供的世界坐标系下的车辆经纬度信息，经过gps坐标转换模块之后结合伪距修正量得到的车辆的绝对定位坐标，通过激光slam定位模块得到在增量式地图上的车辆相对坐标信息，将绝对定位坐标与增量式地图上的车辆相对坐标信息进行无损卡尔曼滤波融合，最终得到车辆的定位信息；本发明通过两种方法对行驶的车辆位置信息进行采集，再将两种方法所得到的信息进行融合，最终得到定位信息，该方法能够提高车辆的可定位性，增加车辆定位的精度与鲁棒性。

附图说明

图1为本发明的控制框图。

具体实施方式

下面结合附图对本发明做进一步说明。

参见图1，本发明包括以下步骤：

步骤一，通过移动站模块得到车辆移动过程中的实时经纬度坐标信息，通过基站模块获得伪距修正量；

步骤二，通过gps坐标转换模块将实时经纬度坐标信息转换为地图坐标系下的坐标，并计算gps在不同锁星数不同工作环境下的协方差矩阵；

步骤三，结合伪距修正量对协方差矩阵进行修正，得到车辆的绝对定位坐标；

步骤四，通过激光slam定位模块感知车辆行驶环境，实时得到车辆相对坐标，通过can总线采集速度转角信息，得到行驶里程，根据行驶里程和实时相对坐标与现有地图进行实时扫描匹配，生成增量式地图，并在增量式地图上记录车辆行驶的相对坐标信息；

步骤五，根据车辆的绝对定位坐标和相对坐标信息，运用无损卡尔曼滤波算法进行融合，得到车辆最终的定位信息，无损卡尔曼滤波算法的预测值为车辆的绝对定位坐标，无损卡尔曼滤波算法的测量值为车辆行驶的相对坐标信息。

gps坐标转换模块接收到实时经纬度坐标信息后，首先经过高斯-克吕格投影，得到投影后的utm坐标系下坐标信息，之后将投影后的utm坐标系下坐标信息与车辆在地图坐标系下的坐标进行平移旋转变换，得到gps坐标在地图坐标系下的坐标。

协方差矩阵通过以下方法获得：

利用gps在不同环境下的锁星数和在该锁星数下的经纬度变化信息，得到在该锁星数时的协方差矩阵；

在不同的环境下进行测量，将锁星数进行阈值划分，相隔两个锁星为一个协方差矩阵，得到不同环境不同锁星数时协方差矩阵；

当gps接收到经纬度信息和锁星数时，将该锁星数对应的协方差矩阵作为实时的协方差矩阵。

基站模块通过3g/4g无线网络通讯格式对数据进行收发。

激光slam定位模块采用单线激光雷达。

增量式地图为二维栅格地图。

差分gps定位模块通过天线接收gps信息和伪距修正量，天线旋拧到磁基座上并固定摆放在高处以保证能够接收到良好的gnss信号，将天线馈线连接到gnss天线和主机单元接口上，同时电源不间断的对主机单元进行供电，得到的基站坐标后，主机单元通过使用射频天线，使用3g/4g无线网络通讯格式，将所获得伪距修正量传输给移动端。

安装时，gnss前后天线分别旋拧到两个磁基座上并分别固定摆放在移动载体的前进方向上，尽可能的将其安置于移动载体的最高处以保证能够接收到良好的gnss信号，接收经纬度信号的主机安装时要保证两个gnss天线相位中心形成的连线、主机与车辆移动中心轴线方向一致或平行，激光雷达安装在车身前部来实时感应外部环境信息。