[发明专利]一种基于多源先验信息的点云匹配高精度定位方法

摘要

本发明公开了一种基于多源先验信息的点云匹配高精度定位方法，智能平台通过IMU数据和GNSS数据获得智能平台t时刻的GNSS全局位姿，通过点云数据获得点云观测数据；根据GNSS全局位姿和点云观测数据创建各个三维先验体素子地图；根据各个三维先验体素子地图的拓扑连通关系建立全局拓扑关系，得到智能平台运行区域的全局先验地图；将GNSS数据与全局先验地图的多源先验信息进行初始数据匹配，得到智能平台在某一三维先验体素子地图中的相对位姿；智能平台运动过程中不断利用当前点云观测数据与三维先验体素子地图进行数据匹配，得到智能平台的局部位姿，然后利用距离智能平台最近的先验路标校正智能平台的位姿，最终得到智能平台的位姿。