arXiv:2607.10597cs.ROcs.SY2026-07

根据运动状态动态调整噪声参数,提升水下定位精度。

Underwater Dead Reckoning with Deployable Situation-Triggered Covariance Scheduling

论文配图:Underwater Dead Reckoning with Deployable Situation-Triggered Covariance Scheduling
图 1 · 摘自论文原文
  • 通过在线触发器识别运动状态,动态切换预设噪声矩阵。
  • 在4次独立测试中,定位误差均值降低0.017米,置信区间[-0.024, -0.008]米。
  • 无需重置滤波器或更换模型,适合实时水下导航场景。

水下死记追踪在视觉不可用且外部定位不可靠时估算载体位置。单一滤波参数虽在多数情况下有效,但在转弯、运动状态转换或传感器测量不可靠时可能表现不佳。本文提出针对BlueROV2的态势触发校准自适应鲁棒扩展卡尔曼滤波器。基于概率触发器实时识别当前运动状态,同时运行一个误差状态滤波器。当触发器置信度高时,仅切换至对应预校准的过程噪声和测量噪声矩阵,不重置状态估计、协方差历史、动力学或测量模型。触发器、噪声配置及一次性的多普勒速度日志偏航对齐校正通过稀疏AprilTag监督的池中实验离线标定。另设验证集选择调度策略,随后固定用于留出测试。在4次留出池中运行中,该方法将标签加权平均每轮位移均方根误差从0.488米降至0.471米,所有留出运行均支持调度方法。对10秒片段进行配对自助法分析,候选减基线差值为-0.017米,95%置信区间[-0.024, -0.008]米,姿态误差基本不变。结果表明,态势感知的协方差调度可在不切换估计器或重置滤波器的前提下,实现微小但稳定的无视觉死记追踪性能提升。

原文摘要 · Abstract (English)

Underwater dead reckoning estimates vehicle position when vision is unavailable and external positioning cannot be assumed. A single set of filter parameters can work well in many situations, but fixed tuning may be poorly matched during turns, motion transitions, or periods when sensor measurements are less reliable. This paper presents the Situation-Triggered Calibrated Adaptive Robust Extended Kalman Filter for a BlueROV2. An onboard probabilistic trigger identifies the current motion situation while one error-state filter runs continuously. When the trigger is confident, the filter changes only to the corresponding pre-calibrated process- and measurement-noise matrices; the state estimate, covariance history, dynamics, and measurement models are not reset or replaced. The trigger, noise profiles, and a one-time Doppler velocity log yaw-alignment correction are calibrated offline using sparse AprilTag-supervised pool runs. A separate validation set selects the scheduling policy, which is then fixed before held-out testing. Across four held-out pool runs, the method reduces label-weighted mean per-run translation root-mean-square error from 0.488 m to 0.471 m relative to the same filter backbone with one global noise profile, and every held-out run favors the scheduled method. A paired bootstrap over 10-second segments gives a candidate-minus-baseline difference of -0.017 m with a 95% confidence interval of [-0.024, -0.008] m, while orientation error remains essentially unchanged. These results indicate that situation-aware covariance scheduling provides a modest but consistent vision-free dead-reckoning improvement without switching estimators or resetting the filter.

水下定位卡尔曼滤波自适应系统机器人导航

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