arXiv:2511.01379cs.RO2025-11中稿 · IROS 2025被引 1

融合激光、惯性、超宽带和轮速信息,实现矿井隧道高精度定位。

CM-LIUW-Odometry: Robust and High-Precision LiDAR-Inertial-UWB-Wheel Odometry for Extreme Degradation Coal Mine Tunnels

  • 基于误差状态卡尔曼滤波,多传感器紧耦合融合
  • 在无信号区仍保持厘米级定位精度,优于现有方法
  • 适合极端环境下的矿用机器人导航

大型复杂、无GPS信号的地下煤矿环境给实时定位与建图(SLAM)带来严峻挑战。传感器面临诸多异常工况:无卫星信号导致场景重建与地理参考困难,地面不平或湿滑影响轮式里程计精度,长而缺乏特征的隧道削弱激光雷达效能。为此,我们提出一种基于迭代误差状态卡尔曼滤波(IESKF)的多模态SLAM框架——CM-LIUW-Odometry。首先,将激光-惯性里程计与超宽带(UWB)绝对定位约束紧密融合,使系统对齐全局坐标;其次,通过非完整约束(NHC)和车辆杠杆臂补偿,增强轮速里程计的紧耦合性能,缓解超出UWB覆盖范围时的精度下降;最后,设计自适应运动模式切换机制,根据UWB信号范围与环境退化程度动态调整机器人运动模式。实测结果表明,该方法在真实矿井环境中显著提升定位精度与鲁棒性,优于当前最优方案。代码已开源,供机器人社区使用。

原文摘要 · Abstract (English)

Simultaneous Localization and Mapping (SLAM) in large-scale, complex, and GPS-denied underground coal mine environments presents significant challenges. Sensors must contend with abnormal operating conditions: GPS unavailability impedes scene reconstruction and absolute geographic referencing, uneven or slippery terrain degrades wheel odometer accuracy, and long, feature-poor tunnels reduce LiDAR effectiveness. To address these issues, we propose CoalMine-LiDAR-IMU-UWB-Wheel-Odometry (CM-LIUW-Odometry), a multimodal SLAM framework based on the Iterated Error-State Kalman Filter (IESKF). First, LiDAR-inertial odometry is tightly fused with UWB absolute positioning constraints to align the SLAM system with a global coordinate. Next, wheel odometer is integrated through tight coupling, enhanced by nonholonomic constraints (NHC) and vehicle lever arm compensation, to address performance degradation in areas beyond UWB measurement range. Finally, an adaptive motion mode switching mechanism dynamically adjusts the robot's motion mode based on UWB measurement range and environmental degradation levels. Experimental results validate that our method achieves superior accuracy and robustness in real-world underground coal mine scenarios, outperforming state-of-the-art approaches. We open source our code of this work on Github to benefit the robotics community.

SLAM多传感器融合矿井导航定位精度

Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。