基于直方图和面特征匹配的3D激光SLAM方法及移动机器人

摘要

本发明公开的基于直方图和面特征匹配的3D激光SLAM方法，包括如下步骤：S1、构建3D激光雷达当前激光帧的直方图HISTt；S2、基于NUM个角度候选项旋转直方图HISTt，获取旋转后的直方图HISTtnum；S3、将直方图HISTtnum与上一时刻直方图HISTt‑1匹配，得分最高的角度候选项yaw∧作为当前时刻的姿态初值；S4、提取当前激光帧的平面特征点集；S5、基于当前激光帧及上一激光帧帧的面特征匹配来优化姿态初值的位姿增量；S6、基于累计的平面特征点云地图进行二次约束，获得激光雷达当前的位姿。通过直方图确定机器人的初始姿态，基于帧间面特征约束，地图面特征二次约束来优化机器人的姿态，并确定机器人的位置，提高现机器人室内室外定位的高精度和稳定性实。