2. 惯性导航系统漂移导致的航迹偏移复现

漂移复现的任务边界与数据基础

本例要回答一个具体问题:某次AUV任务中航迹向右偏出航路带约120 m,是否可由INS的陀螺零偏与加速度计标度因数误差解释。复现不追求还原真实惯导的全部误差项,而是用历史导航日志中的初始对准结果、DVL速度、深度与航向,构建一个可解释的误差传播模型,把“漂移量”算出来并与航路带宽度比较。

可用的历史数据通常包括:任务开始时的初始位置与初始航向、对准结束后的陀螺零偏估计值、加速度计标度因数标定残差、DVL对地速度、深度计数据、以及组合导航输出的位置序列。复现时以组合导航位置为参考真值,用纯惯导递推位置与之比较,得到误差随时间增长曲线。

误差模型与递推关系

在水平面内,忽略姿态耦合的高阶项,位置误差的主要驱动来自航向误差与速度误差。陀螺零偏 ε 引起航向角漂移,航向误差随时间近似线性增长:

Δψ(t) = ε · t

航向误差使速度矢量方向偏转,进而产生横向位置误差。若航向误差较小,横向位置误差近似为:

Δy(t) ≈ ∫ v · sin(Δψ(τ)) dτ ≈ v · ε · t² / 2

加速度计标度因数误差 K 则在存在加速度激励时产生速度误差,再积分成位置误差。对匀速直航段,加速度激励很小,K 的影响主要体现在转向与变速阶段;因此复现时应按航段分段处理,而不是全程用单一常数。

复现的关键不是把公式算得多精确,而是确认误差量级与方向能否解释观测到的偏移。若模型算出的偏移方向与实测相反,优先检查航向符号约定与陀螺零偏的正负号。

用历史数据完成一次复现计算

取一段教学示例数据:AUV以 1.5 m/s 匀速直航 600 s,初始航向 090°,陀螺零偏估计为 0.02 °/h,加速度计标度因数残差 0.05%,该航段内转向两次、每次角速度约 3 °/s。按上述关系估算陀螺零偏贡献:

ε = 0.02 °/h = 0.02 / 3600 °/s ≈ 5.56e-6 °/s
Δψ(600 s) ≈ 5.56e-6 × 600 ≈ 3.33e-3 ° ≈ 5.8e-5 rad
Δy ≈ 1.5 × 5.8e-5 × 600² / 2 ≈ 15.7 m

可见单靠该量级的陀螺零偏,600 s 内只能解释约 16 m 的横向偏移,与 120 m 的观测值相差近一个数量级。这说明要么零偏实际更大,要么加速度计标度因数误差在转向段被放大,要么还存在初始对准航向误差。复现的价值正在于把这几项分开量化,而不是笼统归因于“惯导漂移”。

对加速度计标度因数项,可在转向段用速度增量误差估算:转向期间横向加速度约 v·ω,若 K=0.05%,则速度误差增量约为 0.0005 × v × ω × Δt,再积分得到位置误差。把各航段贡献累加后,与实测偏移对比,即可判断主导项。

INS误差源 → 航迹偏移复现与航路带判读 误差源(历史数据) 陀螺零偏 ε 加计标度因数 K 初始对准航向误差 DVL速度参考 误差传播模型 Δψ(t)=ε·t Δy≈v·ε·t²/2 转向段:K·v·ω·Δt 分段累加各航段贡献 复现结果 纯惯导递推位置 与组合导航对比 误差增长曲线 横向偏移量 判读 偏移 vs 航路带 半宽 50 m 超限→中断 未超→继续 航迹偏移示意(俯视,示例数据) 计划航线中心线 航路带边界(半宽50 m) 起点 复现终点偏移约120 m,超出边界 仅陀螺零偏模型(约16 m) 横向偏移 / m +50 -50

结果判读与复现结论

把模型算出的横向偏移与航路带半宽比较:若复现偏移超过半宽,说明该误差组合足以导致任务中断,排障方向应落在零偏标定与对准质量上;若复现偏移明显小于实测,则说明还有未纳入模型的误差源,例如初始航向装订偏差或DVL速度标度误差,需要回到日志中逐段核对。

检查项示例值判读依据
陀螺零偏贡献约16 m / 600 s远小于实测偏移,非主导项
加计标度因数贡献转向段累加后估算与转向次数和角速度正相关
初始航向误差由对准日志反推恒定方向偏移,易与零偏混淆
航路带半宽50 m复现偏移超限即判为不可接受
复现时务必统一角度单位与符号约定:陀螺零偏用 °/h 还是 rad/s、航向顺时针为正还是逆时针为正,都会改变偏移方向。若复现曲线方向与实测相反,先查约定,再查数据。

完成上述对比后,若确认漂移量超出航路带宽度,即可把结论写回排障记录:主导误差项、复现偏移量、超限时刻,以及建议的纠正措施(重新标定零偏、改进对准、缩短纯惯导工作时间或提高组合导航更新率)。