FIRE-LIVWO：毫米波雷达增强的煤矿井下多模态鲁棒里程计
FIRE-LIVWO是一种面向大型地下煤矿的故障免疫多模态里程计框架：在迭代误差状态卡尔曼滤波（IESKF）中紧耦合4D毫米波雷达、LiDAR、视觉与轮式里程计，于统一VoxelMap中构建LiDAR-雷达点到面残差与稀疏视觉光度残差。烟尘环境下利用毫米波雷达强穿透并引入逐点多普勒速度约束维持可观性，退化巷道中通过非完整约束与在线杆臂补偿抑制漂移；核心贡献是基于几何与视觉可观性分析的退化检测与自适应融合模型切换策略，在线量化可观性并动态调整模态权重。真实煤矿井下实验表明其能准确识别失效边界并可靠切换模态，平均定位误差5.677米，优于对比基线，代码已开源。
原文 · arXiv:2609.05325大型地下煤矿场景对SLAM系统极不友好：密集烟尘与粉尘使视觉信息大量丢失并退化LiDAR点云特征，而绵长自相似巷道造成几何退化，导致里程计显著漂移。多数现有多模态方案在模态失效时缺乏对自身退化状态的感知，仍以固定权重融合，最终在极端条件下发散。FIRE-LIVWO把”何时该信谁”作为一等问题——在线估计系统可观性，并按失效边界动态切换融合策略。
核心创新
FIRE-LIVWO是基于迭代误差状态卡尔曼滤波（IESKF）的紧耦合多模态里程计，将4D毫米波雷达、LiDAR与视觉特征统一到单一VoxelMap中，联合构建LiDAR-雷达点面残差与稀疏视觉光度残差。面对烟尘环境，系统利用4D毫米波雷达的强穿透能力，并引入逐点多普勒速度约束以维持状态可观性；面对几何退化巷道，则以非完整约束（NHC）紧耦合轮式里程计并做在线杆臂补偿来抑制漂移。论文的核心贡献在于退化检测与自适应融合模型切换策略：基于几何与视觉可观性分析在线量化可观性，动态调整各模态权重，实现”故障免疫”式切换。
实验结果
- 在真实地下煤矿环境中开展实验，系统能够准确识别失效边界，在极端条件下实现可靠的模态切换。
- 相较对比基线取得更优的精度与鲁棒性，平均定位误差为5.677米。
- 代码已在GitHub开源，供社区复现与使用。
局限性
摘要仅报告单一平均定位误差（5.677米），未给出不同工况（烟尘浓度、巷道几何）下的误差细分，增益幅度的边界难以独立评估。系统依赖雷达、LiDAR、相机与轮速计的多传感器配置，硬件门槛较高；可观性量化与切换阈值的具体设计细节、以及与最新雷达-惯性方案的对比，均需阅读全文确认。
行业影响
矿山自动化是毫米波雷达+多模态融合最具价值的落地场景之一：井下高价值设备（综采、掘进、辅助运输车辆）的自主化长期受困于烟尘与退化环境下的定位可靠性。FIRE-LIVWO展示的”可观性感知、按需切换”思路同样适用于隧道施工、消防搜救、地下物流等尘烟密集或几何退化场景，为多传感器系统的工程化容错提供了可借鉴的范式。开源代码也降低了后来者复现与适配的成本。