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,再积分得到位置误差。把各航段贡献累加后,与实测偏移对比,即可判断主导项。
结果判读与复现结论
把模型算出的横向偏移与航路带半宽比较:若复现偏移超过半宽,说明该误差组合足以导致任务中断,排障方向应落在零偏标定与对准质量上;若复现偏移明显小于实测,则说明还有未纳入模型的误差源,例如初始航向装订偏差或DVL速度标度误差,需要回到日志中逐段核对。
| 检查项 | 示例值 | 判读依据 |
|---|---|---|
| 陀螺零偏贡献 | 约16 m / 600 s | 远小于实测偏移,非主导项 |
| 加计标度因数贡献 | 转向段累加后估算 | 与转向次数和角速度正相关 |
| 初始航向误差 | 由对准日志反推 | 恒定方向偏移,易与零偏混淆 |
| 航路带半宽 | 50 m | 复现偏移超限即判为不可接受 |
完成上述对比后,若确认漂移量超出航路带宽度,即可把结论写回排障记录:主导误差项、复现偏移量、超限时刻,以及建议的纠正措施(重新标定零偏、改进对准、缩短纯惯导工作时间或提高组合导航更新率)。