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

    公开(公告)号:CN114136311B

    公开(公告)日:2023-08-04

    申请号:CN202111311578.5

    申请日:2021-11-08

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

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

    公开(公告)号:CN114136311A

    公开(公告)日:2022-03-04

    申请号:CN202111311578.5

    申请日:2021-11-08

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

Patent Agency Ranking