V-SLAM中点云配准算法改进及移动机器人实验

针对移动机器人视觉同时定位与地图构建(visual simultaneous location and mapping,V-SLAM)中,存在帧间配准误差大造成重建精度低、位姿轨迹丢失的问题,提出一种三阶段改进点云配准的ICP算法. 首先通过RANSAC(随机采样一致性)采样策略对RGB图进行点对的筛选从而获得内点完成预处理；然后采用基于刚体变换一致性的对应点双重距离阈值法完成点云初配准；在得到良好的初始位姿下,引入一种动态迭代角度因子的ICP精配准方法. 在后端部分引入滑动窗口法和随机采样法相结合的关键帧筛选机制,结合g2o(general graph optimization)图优化算法优化机器人位姿轨迹,实现全局一致的V-SLAM系统. 采用标准点云模型对本文算法与文献算法进行点云配准实验对比,在配准精度上有明显提高；通过移动机器人在真实环境下的地图重建实验,验证了本文算法的有效性；最后基于TUM数据集的实验表明了本文算法能有效估计出机器人运行轨迹.
A three-stage improved point cloud registration ICP algorithm is proposed to deal with the problem of the low reconstruction accuracy, position trajectory loss caused by matching error in the process of inter-frame registration in visual simultaneous location and mapping (V-SLAM) of mobile robots. Firstly, the RANSAC algorithm is used to eliminate the mis-matching of RGB images in preprocessing phrase. Then, rough registration is accomplished by a double distance threshold method based on rigid body transformation consistency. Under a good initial pose, a dynamic iterative angle factor is used to complete the accurate registration of ICP. On the back end, a key frame screening mechanism combining the sliding window method and the random sampling method is introduced. And the robot pose is optimized by combining the general algorithm optimization (g2o) algorithm to construct a globally consistent map V-SLAM system. The standard point cloud model is used to verify that the proposed algorithm has a significant improvement in the accuracy of the registration compared experiment. The effectiveness of the proposed algorithm is validated by the map reconstruction experiment in real environment on the mobile robot. Finally, based on the experiment on TUM dataset, the experimental result shows that this algorithm can estimate the robot′s trajectory effectively.