高级检索

非结构化影响下欠约束激光惯性SLAM系统的精准建图方法

Accurate mapping method for under-constrained LiDAR-inertial SLAM system under unstructured influence

  • 摘要: 井工煤矿现场条件对绝大多数基于激光惯性紧耦合的同步定位及建图系统(Simultaneous Localization and Mapping, SLAM)欠约束,导致煤矿机器人对环境地图的测绘失败,进而使其难以直接进入作业一线。研究分析退化环境中导致里程计漂移的因素,揭示点云非结构化对里程计进入漂移状态的作用机理,提出非结构化的针对性检测方法和尘雾的滤波−插值两步降噪方法,构建基于非结构化状态描述因子的自适应紧耦合里程计。在由WHU-TLS公开数据集Tunnel场地逆向构建的测试环境中,每百米绝对位置误差的均方根误差(EAP-ERMS)约为0.40 m、平均值(EAP-Mean)为0.37 m,相对位置误差的均方根误差(ERP-ERMS)为0.015 m、平均值(ERP-Mean)为0.011 m,总体指标显著优于其他方法。针对挂载超宽带设备的工程化应用需求,采用非线性优化方法维护里程计全局位姿,基于因子图构建非结构化状态约束松弛的里程计因子、UWB(Ultra Wide Band)因子和回环因子。通过对全部因子进行并行全局优化,实现高精度的全局定位及建图。在具备UWB信号的千米级模拟巷道场地中,连续建图EAP-ERMS为1.48 m、EAP-Mean为1.32 m,ERP-ERMS为0.026 m、ERP-Mean为0.013 m。在国家能源集团寸草塔煤矿某巷2 000 m长无回环的现场测试中,连续建图的EAP-ERMS为15.64 m,EAP-Mean为14.53 m,ERP-ERMS为0.198 m,ERP-Mean为0.037 m,验证了系统的工程应用潜力。利用符合防爆要求的16线激光雷达和6轴IMU构建退化场景下精准建图的SLAM系统,对快速推广煤矿机器人的实际应用具有重要意义。

     

    Abstract: Most Simultaneous Localization and Mapping (SLAM) systems that utilize tightly coupled laser-inertial odometry are often under-constrained in underground coal mines, leading to mapping failures and hindering the direct deployment of robots in operational frontlines. This paper analyzes the factors contributing to odometry drift in degraded environments, elucidating the mechanisms by which unstructured point clouds induce drift. We propose a targeted detection method for unstructured regions and a two-step denoising approach that includes filtering and interpolation to address dust and fog. An adaptive tightly coupled odometry system is developed, incorporating a factor that characterizes the state of unstructured areas. In a test environment reverse-engineered from the WHU-TLS Tunnel dataset, our system achieves an EAP-ERMS of approximately 0.40 m, an EAP-Mean of 0.37 m, a ERP-ERMS of 0.015 m, and an ERP-Mean of 0.011 m, outperforming other methods significantly. For engineering applications with Ultra-Wide Band devices, we use a nonlinear optimization method to maintain global odometry poses, constructing a factor graph with unstructured state constraints, UWB factors, and loop closure factors. By performing parallel global optimization on all factors, high-precision global localization and mapping are achieved. In a kilometer-scale simulated tunnel with UWB signals, the continuous mapping results show an EAP-ERMS of 1.48 m, an EAP-Mean of 1.32 m, an ERP-ERMS of 0.026 m, and an ERP-Mean of 0.013 m. In a 2 000 m-long, loop-free field test at Cuncaota Coal Mine, the EAP-ERMS was 15.64 m, the EAP-Mean was 14.53 m, the ERP-ERMS was 0.198 m, and the ERP-Mean was 0.037 m, demonstrating the system's potential for practical engineering applications. Our SLAM system, built with a 16-line LiDAR and a 6-axis IMU that meet explosion-proof standards, provides accurate mapping in degraded scenarios, significantly advancing the practical application of coal mine robots.

     

/

返回文章
返回