基于UWB约束的井下轻量化激光惯性SLAM方法

A Lightweight LiDAR-Inertial SLAM Method for Underground Mine Based on UWB Constraints

  • 摘要: 针对煤矿井下GNSS 信号完全拒止、巷道特征稀疏的环境特点,同时现有SLAM算法存在算力需求高、长距离累积漂移的瓶颈,提出一种基于UWB约束的井下轻量化激光惯性SLAM定位方法。在建图阶段,采用IMU引导的分段式动态畸变补偿解决固态激光雷达点云畸变问题;构建LiDAR-IMU紧耦合里程计,引入巷道几何约束与地面约束提升弱特征场景配准稳定性;利用UWB全局位置观测对位姿进行低频漂移校正,并采用增量式局部地图管理实现轻量化建图。在重定位阶段,基于先验点云地图进行实时匹配定位,同时引入UWB位置观测作为漂移检测与重定位依据:当点云匹配与UWB位置偏差超过阈值时触发预警并调整匹配范围,超过重定位阈值时利用UWB位置辅助恢复定位。井下巷道实验表明,建图效果良好,定位精度与实时性均优于DLO、LILI-OM等主流算法,可满足井下无轨胶轮车无人驾驶的高精度、轻量化定位需求。

     

    Abstract: To address the harsh underground coal mine conditions with complete GNSS outage and sparse roadway geometric features, as well as the inherent drawbacks of conventional SLAM algorithms including heavy computational overhead and severe long-distance cumulative drift, this paper proposes a lightweight LiDAR-inertial SLAM localization method constrained by UWB measurements for underground mining applications. In the mapping process, an IMU-driven piecewise dynamic distortion compensation scheme is employed to rectify point cloud distortion from solid-state LiDAR. A tightly coupled LiDAR-IMU odometer is formulated, where roadway geometric constraints and ground plane constraints are fused to strengthen registration robustness in feature-sparse scenarios. Global UWB position measurements are exploited to suppress low-frequency pose drift, and incremental local map management is adopted to achieve lightweight mapping. During the relocalization phase, real-time matching localization is implemented based on the pre-established prior point cloud map, and UWB readings serve as the judgment standard for drift monitoring and relocalization activation. An early warning is triggered alongside matching range adjustment once the positional deviation between LiDAR matching outputs and UWB data exceeds the preset warning threshold; if the deviation goes beyond the relocalization threshold, UWB coordinates are utilized to assist in recovering the system localization. Experimental results collected in real underground roadways demonstrate that the presented method achieves satisfactory mapping quality. It outperforms state-of-the-art algorithms such as DLO and LILI-OM in localization accuracy and real-time performance, which fulfills the high-precision and lightweight positioning demands of driverless trackless rubber-tyred vehicles in underground coal mines.

     

/

返回文章
返回