arXiv:2609.05325cs.RO2026-09

用毫米波雷达增强多传感器融合,提升矿井中导航的鲁棒性。

FIRE-LIVWO: Robust LiDAR-Inertial-Visual-Wheel Odometry via Failure-Immune mmWave Radar Enhancement

论文配图:FIRE-LIVWO: Robust LiDAR-Inertial-Visual-Wheel Odometry via Failure-Immune mmWave Radar Enhancement
图 1 · 摘自论文原文
  • 融合雷达、激光、视觉与轮速信息,通过状态误差卡尔曼滤波统一建模。
  • 在烟尘环境中利用雷达穿透性,结合多普勒速度约束保持定位可观测性。
  • 动态检测几何退化并自适应切换模态权重,适合复杂地下场景应用。

在结构复杂、退化严重的大型地下煤矿中实现鲁棒的SLAM仍极具挑战。浓烟和粉尘导致视觉信息大量丢失,激光点云特征退化,而长且相似的走廊引发几何退化,造成显著的里程计漂移。为此,我们提出FIRE-LIVWO:一种基于迭代误差状态卡尔曼滤波(IESKF)的紧耦合多模态里程计框架,融合4D毫米波雷达、激光雷达与视觉特征。在统一的体素地图中构建激光-雷达点到平面残差及稀疏视觉光度残差。在烟尘环境中,利用4D毫米波雷达强穿透性,并引入逐点多普勒速度约束以维持状态可观测性;在几何退化走廊中,通过非完整约束(NHC)与在线杠杆臂补偿紧密耦合轮速里程计以降低漂移。核心贡献为基于几何与视觉可观测性分析的退化检测与自适应融合策略,可在线量化可观测性并动态调整模态权重。真实矿井实验表明,FIRE-LIVWO能准确识别失效边界,实现在极端条件下的可靠模态切换。相比基线方法,其定位平均误差仅为5.677m,精度与鲁棒性更优。代码已开源至GitHub,供机器人社区使用。

原文摘要 · Abstract (English)

Achieving robust SLAM in large-scale underground coal mines with complex structures and severe degeneracies remains highly challenging. Dense smoke and dust cause substantial loss of visual information and degrade LiDAR point-cloud features, while long, self-similar corridors induce geometric degeneration, leading to pronounced odometry drift. To address these issues, we propose FIRE-LIVWO: Failure-Immune mmWave Radar-Enhanced LiDAR-Inertial-Visual-Wheel Odometry, a tightly coupled multi-modal odometry framework based on an iterated error-state Kalman filter (IESKF). The framework fuses 4D mmWave radar, LiDAR, and visual features within a unified VoxelMap and jointly constructs LiDAR-radar point-to-plane residuals and sparse visual photometric residuals. In smoke-filled environments, we exploit the strong penetration of 4D mmWave radar and introduce pointwise Doppler velocity constraints to preserve state observability. In geometrically degenerate corridors, we tightly couple wheel odometry using non-holonomic constraints (NHC) and online lever-arm compensation to reduce drift. Our central contribution is a degeneration detection and adaptive fusion model switching strategy grounded in geometric and visual observability analysis, which quantifies observability online and dynamically adjusts modality weights. Real-world experiments in underground coal mines demonstrate that FIRE-LIVWO accurately identifies failure boundaries, enabling reliable modality switching under extreme conditions. Compared with baselines, it achieves superior accuracy and robustness (average localization error of 5.677m). We open source our code on Github to benefit the robotics community.

多传感器融合矿井导航毫米波雷达里程计

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