arXiv:2412.17235cs.RO2024-12被引 14

只在激光雷达失准时融合视觉数据,提升SLAM稳定性与效率

Selective Kalman Filter: When and How to Fuse Multi-Sensor Information to Overcome Degeneracy in SLAM

  • 根据激光雷达状态动态决定是否融合视觉信息
  • 仅在检测到退化时更新对应状态,减少错误传播
  • 适合对实时性与鲁棒性要求高的自动驾驶场景

当前SLAM系统趋向多传感器融合以应对复杂退化环境。然而,现有方法普遍采用全量融合策略(all-in),虽整合多源优势,却也引入各自缺陷,降低鲁棒性与精度,并带来高计算开销。为此,本文提出选择性卡尔曼滤波(Selective Kalman Filter):通过在激光雷达SLAM中检测退化,仅当其出现退化时才融合视觉观测。针对退化检测,提出一种简洁有效的方法,可识别退化方向并充分考虑旋转与平移约束的耦合关系。在融合策略上,仅用视觉数据更新退化状态。实验表明,该方法在退化处理上精度与鲁棒性优于现有先进方法,且相比all-in方法显著提升实时性能。代码已开源。

原文摘要 · Abstract (English)

Research trends in SLAM systems are now focusing more on multi-sensor fusion to handle challenging and degenerative environments. However, most existing multi-sensor fusion SLAM methods mainly use all of the data from a range of sensors, a strategy we refer to as the all-in method. This method, while merging the benefits of different sensors, also brings in their weaknesses, lowering the robustness and accuracy and leading to high computational demands. To address this, we propose a new fusion approach -- Selective Kalman Filter -- to carefully choose and fuse information from multiple sensors (using LiDAR and visual observations as examples in this paper). For deciding when to fuse data, we implement degeneracy detection in LiDAR SLAM, incorporating visual measurements only when LiDAR SLAM exhibits degeneracy. Regarding degeneracy detection, we propose an elegant yet straightforward approach to determine the degeneracy of LiDAR SLAM and to identify the specific degenerative direction. This method fully considers the coupled relationship between rotational and translational constraints. In terms of how to fuse data, we use visual measurements only to update the specific degenerative states. As a result, our proposed method improves upon the all-in method by greatly enhancing real-time performance due to less processing visual data, and it introduces fewer errors from visual measurements. Experiments demonstrate that our method for degeneracy detection and fusion, in addressing degeneracy issues, exhibits higher precision and robustness compared to other state-of-the-art methods, and offers enhanced real-time performance relative to the all-in method. The code is openly available.

SLAM多传感器融合卡尔曼滤波退化检测

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