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

Lightweight LiDAR-inertial SLAM for underground mines with UWB constraints

  • 摘要: 针对煤矿井下全球导航卫星系统(GNSS)信号完全拒止、巷道特征稀疏的环境特点,现有实时定位与地图构建(SLAM)算法存在算力需求高、长距离累计漂移等瓶颈。针对该问题,提出一种基于UWB约束的井下轻量化激光惯性SLAM方法。在建图阶段,采用惯性测量单元(IMU)引导的分段式动态畸变补偿解决固态激光雷达点云畸变问题;构建激光雷达−IMU紧耦合里程计,引入巷道几何约束与地面约束提升弱特征场景配准稳定性;利用超宽带(UWB)全局位置观测对位姿进行低频漂移校正,并采用增量式局部地图管理实现轻量化建图。在重定位阶段,基于先验点云地图进行实时匹配定位,同时引入UWB位置观测作为漂移检测与重定位依据:当点云匹配与UWB位置偏差超过阈值时触发预警并调整匹配范围,超过重定位阈值时利用UWB位置辅助恢复定位。井下典型工况试验结果表明:该方法建图完整精准、轨迹一致性良好,可实现分米级稳定定位;平面位置均方根误差(RMSE)为0.22 m,定位精度与实时性显著优于主流激光惯性SLAM算法,且定位稳定性高于单一UWB定位;重定位机制能够稳定恢复2~4 m的位置漂移,当初始偏差增大至6 m时,重定位成功率和校正精度有所下降,但总体仍能实现有效的位置恢复。

     

    Abstract: In underground coal mines, Global Navigation Satellite System (GNSS) signals are completely unavailable and roadway features are sparse, posing challenges to existing Simultaneous Localization and Mapping (SLAM) algorithms, including high computational requirements and cumulative drift over long distances. To address these problems, a lightweight LiDAR-inertial SLAM method for underground mines with Ultra-Wideband (UWB) constraints was proposed. During mapping, segmented dynamic distortion compensation guided by an Inertial Measurement Unit (IMU) was used to address point cloud distortion in solid-state LiDAR. Tightly coupled LiDAR-IMU odometry was developed, and roadway geometric constraints and ground constraints were introduced to improve registration stability in feature-sparse scenes. Global UWB position observations were used to correct pose drift at a low frequency, and incremental local map management was adopted for lightweight mapping. During relocalization, real-time localization was performed by matching point clouds to a prior cloud map, with UWB position observations providing a basis for drift detection and relocalization. When the discrepancy between the position estimated by point cloud matching and the UWB position exceeded a threshold, a warning was triggered and the matching range was adjusted. When the relocalization threshold was exceeded, the UWB position was used to assist localization recovery. Tests under typical underground operating conditions showed that the method produced complete, accurate maps and consistent trajectories and achieved stable decimeter-level localization. The planar position Root Mean Square Error (RMSE) was 0.22 m. Localization accuracy and real-time performance were significantly better than those of mainstream LiDAR-inertial SLAM algorithms, and localization was more stable than with UWB alone. The relocalization mechanism reliably corrected position drift of 2–4 m. When the initial deviation increased to 6 m, the relocalization success rate and correction accuracy decreased, but effective position recovery was still achieved overall.

     

/

返回文章
返回