高级检索

基于ORB-SLAM3视觉与惯导融合的煤矿机器人定位算法研究

Research on coal mine robot positioning algorithm based on integration of ORB-SLAM3 vision and inertial navigation

  • 摘要: 针对煤矿井下空间狭窄、光线昏暗且严重不均匀使矿井图像存在照度低、纹理稀疏、颜色失真等缺陷,严重影响了视觉SLAM特征点提取匹配结果,导致定位性能急剧下降,提出1种基于改进ORB-SLAM3算法的煤矿移动机器人单目视觉定位算法。首先对ORB-SLAM3定位算法进行改进,在前端特征点提取(ORB)算法的基础上引入了直方图均衡化、非极大值抑制法、自适应阈值法以及基于四叉树策略的特征点均匀化性质;然后在特征点匹配工作中,引入了基于图像金字塔的LK光流法,减少优化的迭代次数,在特征点匹配完成后加入RANSAC算法去除误匹配的特征点,提高特征点的匹配准确率。在后端通过三角测量的方法,得到像素的深度信息,将2D−2D位姿求解问题转化成3D−2D(pnp)位姿求解问题。根据视觉惯导紧耦合的原理,通过融合视觉残差和IMU残差构建整个定位系统的残差函数,并使用基于非线性优化的滑动窗口BA算法不断迭代优化残差函数,获取精确的移动机器人位姿估计。将改进后的算法在4个数据集下与ORB-SLAM3算法以及VINS-Mono算法进行了充分的对比实验。研究表明:① 相比于ORB-SLAM3算法以及VINS-Mono算法,提出定位系统的运动轨迹和真值轨迹最接近;② 提出定位系统的APE各项指标均优于ORB-SLAM3算法以及VINS-Mono算法;③ 提出定位系统均方根误差为0.049 m(4次实验平均值),相较于ORB-SLAM3均方根误差降低了31.1%(四次实验平均值)。

     

    Abstract: Due to the narrow underground environment of coal mine, dark and changeable light, the mine image has the characteristics of low illumination, low contrast map and uneven color, which affects the matching result of visual SLAM feature points extraction and makes the positioning performance drop sharply. In order to improve the positioning accuracy of monocular visual positioning algorithm of coal mine mobile robot in low illumination, weak texture and unstructured environment features, the ORB-SLAM3 positioning algorithm is improved. On the basis of the front-end feature point extraction (ORB) algorithm, histogram equalization, non-maximum suppression, adaptive threshold method and feature point homogenization based on quadtree strategy are introduced. In feature point matching, LK optical flow method based on image pyramid is introduced to reduce the number of optimization iterations. After the feature point matching is completed, the RANSAC algorithm is added to remove the mismatched feature points and improve the matching accuracy of the feature points. Through the method of triangulation at the back end, the pixel depth information is obtained, and the 2D-2D pose solving problem is transformed into 3D-2D (pnp) pose solving problem. According to the principle of tight coupling of visual inertial navigation, the residual function of the whole positioning system is constructed by fusing visual residual error and IMU residual error, and the sliding window BA algorithm based on nonlinear optimization is used to iteratively optimize the residual function to obtain accurate pose estimation of the mobile robot. The improved algorithm is compared with ORB-SLAM3 algorithm and VSIN-Mono algorithm in four data sets. The results show that: (1) Compared with the ORB-SLAM3 algorithm and the VMS-MONO algorithm, the motion trajectory of the proposed positioning system is the closest to the true value trajectory; (2) All indexes of APE of the positioning system are better than ORB-SLAM3 algorithm and VMS-MONO algorithm; The root-mean-square error of the positioning system is 0.049m (the mean value of four experiments), which is 31.1% lower than that of ORB-SLAM3 (the mean value of four experiments).

     

/

返回文章
返回