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.
翻译:激光雷达-惯性里程计(LIO)因其高精度而在机器人领域得到广泛应用。然而,在退化环境中(如长走廊和高空飞行场景),其性能会显著下降,这些环境中激光雷达测量值存在不平衡或稀疏性问题,导致状态估计不适定。本文提出LODESTAR,一种新颖的LIO方法,通过两个关键模块应对此类退化问题:退化感知自适应施密特-卡尔曼滤波器(DA-ASKF)与退化感知数据利用(DA-DE)。DA-ASKF采用滑动窗口机制,将历史状态与测量值作为附加约束。具体而言,该方法引入退化感知滑动模式,根据退化程度自适应地将状态分类为活跃状态或固定状态。通过施密特-卡尔曼更新,在部分优化活跃状态的同时保持固定状态不变。这些固定状态通过其协方差影响活跃状态的更新,起到类似“导航星”的参考锚点作用。此外,DA-DE模块基于局部化贡献度与雅可比矩阵条件数,对活跃状态中信息量较低的测量值进行剪枝,并选择性利用固定状态的测量值。因此,DA-ASKF实现了退化感知约束优化并缓解测量稀疏性问题,而DA-DE则解决了测量不平衡问题。实验结果表明,在各种退化条件下,LODESTAR在精度与鲁棒性方面均优于现有激光雷达里程计方法及退化感知模块。