A three-dimensional reconstruction method of coal mine tunnel fused with LiDAR and IMU
毛清华柴建权陈彦璋薛旭升王川伟
MAO Qinghua;CHAI Jianquan;CHEN Yanzhang;XUE Xusheng;WANG Chuanwei
西安科技大学 机械工程学院陕西省矿山机电装备智能检测与控制重点实验室
针对煤矿掘进巷道存在典型非结构化、特征退化、大尺度环境,巷道三维重建易出现位姿估计精度低、累计漂移误差大等问题,提出了一种激光雷达和惯导(Inertial Measurement Unit,IMU)融合的煤矿掘进巷道三维重建方法。该方法通过迭代卡尔曼滤波将激光雷达观测模型的残差函数和IMU预测模型的先验状态偏差紧耦合,经状态更新得到更为精确的后验状态,提升了退化环境下的位姿估计精度。为降低巷道三维模型重建过程中的累计漂移误差,提出基于体素化广义迭代最近点(Voxelized Generalized ICP,VGICP)的回环检测算法,以基于体素的单分布到多分布的方式进行配准,完成对回环帧的选取及精确匹配,实现回环帧的全局位姿校正,有效降低煤矿巷道三维重建的累计漂移误差。相比于A-LOAM、LEGO-LOAM、LINS算法,所提算法在位姿估计精度和全局一致性方面显著提升。公开数据集实验结果表明:所提算法的RPE和APE均方根误差分别为
In view of the problems of typical unstructured, degraded characteristics and large-scale environment in coal mine tunnel, and the 3D reconstruction of coal mine tunnel is prone to low pose estimation accuracy and large cumulative drift error, a 3D reconstruction method of coal mine tunnel fused with lidar and inertial measurement unit (IMU) is proposed. In this method, the residual function of the lidar observation model and the prior state deviation of the IMU prediction model are tightly coupled through iterative kalman filter, and a more accurate posteriori state is obtained through state update, which provides reliable pose estimation for the degraded environment. In order to reduce the cumulative drift error in the process of tunnel 3D model reconstruction, a loopback detection algorithm based on Voxelized Generalized ICP (VGICP) is proposed. It is registered in a voxel-based single to multi-distribution mode, so as to complete the selection and accurate matching of loopback keyframes, realize the global pose correction of loopback keyframes, and effectively reduce the cumulative drift error of 3D reconstruction of coal mine tunnel. Compared with the A-LOAM and LEGO-LOAM algorithms, the proposed algorithm has significantly improved the accuracy and global consistency of pose estimation. Experimental results on public datasets show that the root mean square errors of RPE and APE of the proposed algorithm are
煤矿巷道三维重建激光雷达惯导迭代卡尔曼滤波回环检测
coal mine tunnel;3D reconstruction;lidar;inertial navigation;iterative kalman filter;loopback detection
主办单位:煤炭科学研究总院有限公司 中国煤炭学会学术期刊工作委员会