摘要
一种结合GPS和雷达里程计的SLAM方法,包括如下步骤:1)采集差分GPS数据和来自激光雷达的点云数据;2)处理GPS数据获得位移(X,Y,Z)和姿态RPY角;3)匹配GPS数据和LiDAR的点云数据,通过时间戳对齐的方式实现数据匹配;4)结合步骤2)处理GPS得到的位姿数据和LiDAR的点云数据检验GPS数据的可靠性;5)使用雷达里程计算法LOAM获取(X,Y,Z)和RPY角;6)在GPS数据可靠的地方,使用GPS获取的位姿作为最终的位姿;在GPS数据不可靠的路段,利用该路段起点和终点的GPS位姿优化LOAM算法的位姿来获取最终的位姿;7)使用步骤6)输出的位姿转换激光雷达的点云数据到世界坐标系下,获取最终的全局地图。本发明适用于大范围城市三维地图的构建。