一种基于IMU预积分的激光SLAM定位方法

摘要

本发明公开了一种基于IMU预积分的激光SLAM定位方法，包括步骤1：在获取当前IMU与激光雷达测量数据的基础上，对当前时刻IMU进行状态预测与预积分；步骤2：利用IMU状态预测得到的预测值，消除激光雷达数据测量产生的点云畸变；步骤3：从畸变后的点云中进行特征提取，提取边缘点与平面点；步骤4：将一段时间内不同时间戳下所提取的特征点投影至同一坐标系下，形成一个点云局部地图；步骤5：根据局部地图，确定所提取特征与局部地图间的对应关系，得到相对激光雷达测量；步骤6：以LiDAR相对测量残差和IMU预积分残差为约束条件，建立非线性最小二乘目标函数，并联合优化求解，将结果用于更新IMU预测的状态变量，消除IMU在传递过程中的误差。