基于深度惯性里程计的巡检机器人地下空间同时定位和地图构建方法

摘要

一种基于深度惯性里程计的巡检机器人地下空间同时定位和地图构建方法，利用深度相机和惯性测量单元进行松耦合，通过深度相机采集的深度图获取点云信息，提取平面特征；将深度相机采集的RGB图像转换成灰度图和平面特征融合，利用迭代最近点算法进行优化；迭代最近点优化后的数据和惯性测量单元数据进行松耦合，利用回环检测提高位姿图精度，得到巡检机器人运行轨迹、点云地图和树跳表地图，达到巡检机器人在室内同时定位和地图构建的效果。通过此方法提高巡检机器人在地下空间的同时定位精度和鲁棒性，达到巡检机器人在地下空间同时定位和地图构建的效果。巡检机器人在地下空间进行作业时，在强旋转环境下本发明采用的方法具有良好鲁棒性。