The fusion scheme is crucial to the multi-sensor fusion method that is the promising solution to the state estimation in complex and extreme environments like underground mines and planetary surfaces. In this work, a light-weight iEKF-based LiDAR-inertial odometry system is presented, which utilizes a degeneration-aware and modular sensor-fusion pipeline that takes both LiDAR points and relative pose from another odometry as the measurement in the update process only when degeneration is detected. Both the CRLB theory and simulation test are used to demonstrate the higher accuracy of our method compared to methods using a single observation. Furthermore, the proposed system is evaluated in perceptually challenging datasets against various state-of-the-art sensor-fusion methods. The results show that the proposed system achieves real-time and high estimation accuracy performance despite the challenging environment and poor observations.
翻译:多传感器融合中的融合方案是解决复杂和极端环境(如地下矿井和行星表面)中状态估计问题的关键方案。本文提出了一种轻量级基于迭代扩展卡尔曼滤波(iEKF)的激光雷达-惯性里程计系统,该系统采用退化感知与模块化传感器融合流程,仅在检测到退化时才将激光雷达点云和来自另一里程计的相对位姿作为更新过程中的观测值。通过克拉美-罗下界(CRLB)理论和仿真测试,证明了本方法相比仅使用单一观测的方法具有更高精度。此外,在感知挑战性数据集上,将所提系统与多种先进传感器融合方法进行了对比评估。结果表明,尽管面临恶劣环境和不良观测条件,该系统仍能实现实时高精度状态估计。