LODESTAR: Degeneracy-Aware LiDAR-Inertial Odometry with Adaptive Schmidt-Kalman Filter and Data Exploitation
Preprint
Abstract
LiDAR-inertial odometry (LIO) has been widely used in robotics due to its high accuracy. However, its performance degrades in degenerate environments, such as long corridors and high-altitude flights, where LiDAR measurements are imbalanced or sparse, leading to ill-posed state estimation. In this letter, we present LODESTAR, a novel LIO method that addresses these degeneracies through two key modules: degeneracy-aware adaptive Schmidt-Kalman filter (DA-ASKF) and degeneracy-aware data exploitation (DA-DE). DA-ASKF employs a sliding window to utilize past states and measurements as additional constraints. Specifically, it introduces degeneracy-aware sliding modes that adaptively classify states as active or fixed based on their degeneracy level. Using Schmidt-Kalman update, it partially optimizes active states while preserving fixed states. These fixed states influence the update of active states via their covariances, serving as reference anchors--akin to a lodestar. Additionally, DA-DE prunes less-informative measurements from active states and selectively exploits measurements from fixed states, based on their localizability contribution and the condition number of the Jacobian matrix. Consequently, DA-ASKF enables degeneracy-aware constrained optimization and mitigates measurement sparsity, while DA-DE addresses measurement imbalance. Experimental results show that LODESTAR outperforms existing LiDAR-based odometry methods and degeneracy-aware modules in terms of accuracy and robustness under various degenerate conditions.Keywords
All Related Versions
This publication has 18 references indexed in Scilit:
- NA-LOAM: Normal-Based Adaptive LiDAR Odometry and MappingIEEE Sensors Journal, 2024
- iG-LIO: An Incremental GICP-Based Tightly-Coupled LiDAR-Inertial OdometryIEEE Robotics and Automation Letters, 2024
- SW-LIO: A Sliding Window Based Tightly Coupled LiDAR-Inertial OdometryIEEE Robotics and Automation Letters, 2023
- KISS-ICP: In Defense of Point-to-Point ICP – Simple, Accurate, and Robust Registration If Done the Right WayIEEE Robotics and Automation Letters, 2023
- Hilti-Oxford Dataset: A Millimeter-Accurate Benchmark for Simultaneous Localization and MappingIEEE Robotics and Automation Letters, 2022
- The Hilti SLAM Challenge DatasetIEEE Robotics and Automation Letters, 2022
- STEP: State Estimator for Legged Robots Using a Preintegrated Foot Velocity FactorIEEE Robotics and Automation Letters, 2022
- Direct LiDAR Odometry: Fast Localization With Dense Point CloudsIEEE Robotics and Automation Letters, 2022
- Run Your Visual-Inertial Odometry on NVIDIA Jetson: Benchmark Tests on a Micro Aerial VehicleIEEE Robotics and Automation Letters, 2021
- Integrating generic sensor fusion algorithms with sound state representations through encapsulation of manifoldsInformation Fusion, 2013