arXiv:2608.29514cs.RO2026-08中稿 · the IEEE Internati…

解决惯性导航中未知延迟传感器数据的同步问题,提升定位精度与一致性。

A Sliding Window Filter on the Galilean Group for Consistent Aided Inertial Navigation with Unknown Measurement Delays

论文配图:A Sliding Window Filter on the Galilean Group for Consistent Aided Inertial Navigation with Unknown Measurement Delays
图 1 · 摘自论文原文
  • 在伽利略群上建模,联合估计延迟与导航状态,保持时空一致性。
  • 单个延迟测量存在不可观测性,易导致估计过自信;多测量联合处理可消除此缺陷。
  • 采用滑动窗口滤波器,短历史状态协同修正,显著提升估计一致性。

研究辅助惯性导航中,当辅助传感器测量存在未知恒定延迟时的联合估计问题。目标是同时估计延迟与导航状态,使延迟测量能在正确时间修正轨迹,从而获得更准确的导航解。本文在特殊伽利略群上构建模型,为运动与时间不确定性提供自然的状态空间结构。分析联合延迟与状态估计的可观测性,发现单个延迟测量存在精确对称性:延迟变化可被状态调整抵消,导致测量不变。单独处理测量会使虚假信息沿测量雅可比矩阵的零空间传播,造成过度自信且不一致的估计。当轨迹足够丰富时,多个时刻的测量联合处理可消除该方向。基于此,提出一种滑动窗口滤波器,保留短期导航状态历史,并在活动窗口内联合应用延迟辅助修正。通过一系列仿真验证估计精度与一致性,结果表明:不维持足够窗口的估计器会迅速变得高度不一致,而即使短滑动窗口也能显著改善一致性,提供可观测性所需的时序支持。

原文摘要 · Abstract (English)

We study aided inertial navigation when the aiding sensor measurements are subject to an unknown constant delay. The goal is to estimate the delay and navigation state jointly so that delayed measurements correct the trajectory at the appropriate times, yielding a more accurate navigation solution. We formulate the problem on the special Galilean group, which provides a natural state-space structure for aided navigation with uncertainty in both motion and timing. We then examine the observability of joint delay and state estimation and show that, for a single delayed measurement, the model admits an exact symmetry in which a change in the delay can be compensated by a change in the navigation state, leaving the measurement unchanged. Processing measurements individually allows spurious information to `leak' along the corresponding null direction of the measurement Jacobian, producing overconfident and inconsistent estimates. Applying measurements from multiple times together can eliminate this direction when the trajectory is informative enough. Motivated by this result, we develop a sliding window filter that retains a short history of navigation states and applies delayed aiding corrections jointly across the active window. We conduct a series of simulation studies to characterize estimator accuracy and consistency. The simulations demonstrate that an estimator that does not maintain an adequate window can rapidly become highly inconsistent, whereas even a short sliding window markedly improves consistency by providing the temporal support that observability requires.

惯性导航状态估计滑动窗口延迟补偿

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