一种基于面线角点特征提取的激光SLAM方法
摘要:
本发明公开一种基于面线角点特征提取的激光SLAM方法,包括以下步骤:(1)初始化地图和各类参数,分配内存;(2)收集3D激光雷达采集到的点云;(3)对采集到的点云进行数据预处理;(4)进行投影;(5)进行阻塞点去除;(6)提取面、线、角点特征;(7)对面、线特征进行表面法向量估计;(8)对角点特征信息进行前端配准计算;(9)剔除掉点云中的冗余部分,保存关键帧信息,位姿信息和载体的轨迹信息;(10)对关键帧信息和运动轨迹信息进行回环检测;(11)进行后端优化;(12)更新位姿,融合建图,发布地图信息和轨迹信息;(13)跳转至步骤(2),继续运行,直到建图完成或者关闭进程。
公开/授权文献
0/0