高级检索

煤矿井下点云特征提取和配准算法改进与激光SLAM研究

Improvement of point cloud feature extraction and alignment algorithms and lidar slam in coal mine underground

  • 摘要: 激光SLAM在狭长局促的煤矿井下非结构化环境中面临退化问题的挑战,在特征很少或者特征复杂的情况下,位姿估计不准确,导致建图失真甚至失败。针对煤矿井下非结构退化环境中激光点云特征提取与配准困难的问题,提出了一种融合FPFH和ICP算法的二阶段点云特征提取及配准的方法,首先构建源点云和目标点云的kd-tree结构,利用统计滤波和体素滤波降低点云数量,提取点云表面法线并计算关键点云的快速点特征直方图特征描述子,再利用采样一致性初始配准算法进行粗配准,然后采用ICP算法进行精配准,以提升点云配准的准确性和位姿估计的精度;改进了LIO-SAM算法的特征提取和配准算法以及后端回环因子图优化算法,提升其关键局部特征识别与配准能力,利用Scan Context全局描述符闭环因子改善其闭环检测性能,以获得精确的全局一致性地图。利用M2DGR公开数据集测试了改进算法的性能,开展了2种煤矿井下典型场景的模拟SLAM试验,验证改进算法在特征提取和配准方面的有效性。测试和试验结果表明,与传统的LIO-SAM算法相比,改进算法的位姿估计和点云配准精度更高,相对位姿误差的平均误差改善了6.52%,绝对位姿误差的最大误差降低了18.84%,构建的地图无明显失真,建图误差均在1%以内,可实现非结构化退化环境的高精度全局一致性地图构建。

     

    Abstract: LiDAR SLAM faces challenges in the narrow and confined unstructured environment of underground coal mines, where inaccurate point cloud pose estimation due to few or complex features can result in distortion or even map construction failure. To address the difficulties in LiDAR point cloud feature extraction and registration in this degraded environment, a two-stage method integrating FPFH and ICP algorithms is proposed. Initially, the method constructs kd-tree structures for the source and target point clouds, reduces point cloud numbers through statistical and voxel filtering, extracts point cloud surface normal, and computes fast point feature histogram descriptors for key points. Subsequently, a coarse registration is performed using the sampling consistency initial registration algorithm, followed by fine registration using the ICP algorithm to enhance point cloud registration accuracy and pose estimation precision. Furthermore, enhancements are made to the feature extraction and registration algorithm of the LIO-SAM, along with the optimization algorithm of the back-end loopback factor, to improve key local feature identification and registration capabilities. The addition of the Scan Context global descriptor loop factor enhances loop detection accuracy for consistent global mapping. Experimental testing on the M2DGR public dataset and SLAM experiments in simulated coal mine scenarios demonstrate the effectiveness of the improved algorithm in feature extraction and registration of the point clouds. Compared to the traditional LIO-SAM algorithm, the improved algorithm showcases higher accuracy in pose estimation and point cloud registration, with a 6.52% improvement in average relative position error and an 18.84% reduction in maximum absolute position error. The resulting maps exhibit no obvious distortion and mapping errors are within 1%, allowing for the construction of high-precision consistent global maps in unstructured and degraded environments.

     

/

返回文章
返回