首页 >

面向星表非结构化环境的几何退化抑制激光-惯性SLAM方法-AFC 2026 增刊

余萌1,路晨曦1,王寅2   

  1. 1. 南京航空航天大学航天学院
    2. 南京航空航天大学
  • 收稿日期:2026-06-01 修回日期:2026-07-30 出版日期:2026-08-10 发布日期:2026-08-10
  • 通讯作者: 路晨曦
  • 基金资助:
    国家重点研发计划;甬江人才计划

Geometric degeneracy mitigation LiDAR-inertial SLAM method for unstructured planetary environments

  • Received:2026-06-01 Revised:2026-07-30 Online:2026-08-10 Published:2026-08-10
  • Contact: Chen-Xi LU

摘要: 星表巡视探测任务对自主导航系统的精度与可靠性提出了极高要求。然而,地外天体表面(如月球、火星)广泛存在大面积平坦沙地、非规则陨石坑及散乱岩石等典型非结构化地貌,此类环境会导致传统的激光-惯性里程计(LIO)在特定自由度上出现几何退化,进而引发状态估计发散和轨迹漂移问题,威胁巡视器的安全运行。针对上述难题,本文提出了一种融合在线退化检测与主动约束机制的鲁棒SLAM方法。首先,在迭代误差状态卡尔曼滤波的更新阶段,利用点面距离观测方程的Hessian矩阵构建近似Fisher信息矩阵, 并通过实时特征值分解量化状态空间的可观测度。其次,设计基于特征值阈值的主动约束策略,当特定方向特征值低于阈值时,判定发生几何退化,并引入虚拟观测施加零残差硬约束,使系统在该维度依赖惯性测量单元预积分约束。基于高保真月面仿真场景的实验结果表明,与现有LIO算法相比,本文方法能准确识别退化方向,有效消除了在特征缺失方向上的无界漂移,在长距离行驶实验中保持了较高的轨迹一致性。研究结果证明,所提出的主动约束方法有效解决了星表非结构化环境下的几何退化难题,显著提升了星表巡视器自主定位精度与鲁棒性。

关键词: 星表巡视器, 非结构化场景, 同步定位与建图, 激光-惯性里程计, 几何退化检测

Abstract: Planetary surface exploration missions impose stringent requirements on the accuracy and reliability of autonomous navigation systems. However, extraterrestrial surfaces (e.g., the Moon and Mars) are characterized by typical unstructured terrains, such as extensive flat sandy areas, irregular craters, and scattered rocks. Such environments often induce geometric degeneracy in tradi-tional LiDAR-Inertial Odometry (LIO) systems along specific degrees of freedom, subsequently causing state estimation diver-gence and trajectory drift, which pose threats to the safe operation of rovers. To address these challenges, this paper proposes a robust SLAM method that integrates online degeneracy detection with an active constraint mechanism. First, during the update phase of the Iterated Error-State Kalman Filter (IESKF), an approximate Fisher Information Matrix (FIM) is constructed using the Hessian matrix derived from the point-to-plane distance observation equation. The observability of the state space is then quantified via real-time eigenvalue decomposition. Second, an active constraint strategy based on eigenvalue thresholds is de-signed. When the eigenvalue in a specific direction falls below a preset threshold, geometric degeneracy is identified. Subse-quently, virtual observations are introduced to impose zero-residual hard constraints, forcing the system to rely on Inertial Meas-urement Unit (IMU) pre-integration constraints in the degenerate dimensions. Experimental results based on the LuSNAR plane-tary simulation dataset demonstrate that, compared with existing LIO algorithms, the proposed method accurately identifies de-generate directions and effectively eliminates unbounded drift in feature-deprived directions, maintaining high trajectory con-sistency during long-distance navigation. The results verify that the proposed active constraint method effectively resolves the geometric degeneracy problem in unstructured planetary environments, significantly enhancing the autonomous localization accuracy and robustness of planetary rovers.

Key words: planetary rover, unstructured environment, simultaneous localization and mapping, LiDAR-inertial odometry, geo-metric degeneracy

中图分类号: