一种基于先验地图的LiDAR/IMU融合定位方法
Abstract:
本发明公开了一种基于先验地图的LiDAR/IMU融合定位方法,首先对先验点云地图按照自定义网格大小进行分块,以解决大场景点云地图无法在计算能力受限的平台上加载和运行的问题;再设计基于LiDAR/IMU的融合定位方案,通过正态分布变换(NDT)算法进行激光雷达点云与分块地图的匹配,将实时点云与先验地图进行关联;其中还采用IMU预积分为地图匹配提供高频的初始猜测,将相邻两个激光雷达帧之间的IMU测量数据的积分转换到IMU坐标系下进行,实时计算相邻两时刻的速度、位置和旋转,为地图匹配提供高频的初始猜测,估计车辆实时位姿,实现位置定位。与传统NDT定位方法相比较,在定位鲁棒性和准确性上均有大幅度提高。
Public/Granted literature
Patent Agency Ranking
0/0