4. 惯导误差传播方程与误差抑制策略总览

惯导系统的核心问题不在于“有没有误差”，而在于“误差如何随时间演化”。AUV在水下长时间航行时，加速度计零偏、陀螺零偏、初始对准误差、标度因数误差等会通过积分环节逐级放大，最终表现为速度漂移、位置发散和姿态缓慢偏转。理解误差传播方程，是设计融合算法与抑制策略的前提。本节先建立Phi角与Psi角两种误差状态方程，再分析误差累积特性，最后给出误差抑制的技术路线总览。

一、坐标系与符号约定

全文采用右手坐标系：导航系n取北-东-地（NED），载体系b取右-前-上（RFU），地球系e与惯性系i按常规定义。姿态误差角统一记为φ，速度误差记为δv，位置误差记为δp，陀螺零偏记为ε_b，加速度计零偏记为∇_b。所有误差量均定义为“计算值减真实值”，即δx = x̂ − x。这一约定在后续推导中保持一致，切换模型时不再重复说明。

二、Phi角误差状态方程

Phi角模型将姿态误差视为导航系下的等效旋转矢量φ，适用于误差角较小、导航系可视为惯性系近似的场景。其姿态误差方程可写为：

φ̇ = −ω<sub>in</sub><sup>n</sup> × φ + δω<sub>in</sub><sup>n</sup> − C<sub>b</sub><sup>n</sup> ε<sub>b</sub>

其中ω_inⁿ为导航系相对惯性系的旋转角速度在n系下的投影，C_bⁿ为姿态矩阵。速度误差方程与位置误差方程分别为：

δv̇ = −(2ω<sub>ie</sub><sup>n</sup> + ω<sub>en</sub><sup>n</sup>) × δv − (δω<sub>ie</sub><sup>n</sup> + δω<sub>en</sub><sup>n</sup>) × v
      + f<sup>n</sup> × φ + C<sub>b</sub><sup>n</sup> ∇<sub>b</sub>
δṗ = δv − (ω<sub>en</sub><sup>n</sup> ×) δp

式中fⁿ为比力在导航系下的投影。可以看到，姿态误差通过fⁿ×φ项耦合进速度误差，速度误差再积分成位置误差，形成“姿态→速度→位置”的级联传播链。对于AUV常用的中低精度MEMS惯导，陀螺零偏ε_b通常在1～10 °/h量级，加速度计零偏∇_b在1～5 mg量级，这些参数直接决定误差发散速度。

三、Psi角误差状态方程

Psi角模型将姿态误差定义为计算导航系与真实导航系之间的小角度旋转ψ，其优势在于误差方程中不显含位置误差对姿态的耦合项，更适合大方位失准角或长航时场景。其姿态误差方程为：

ψ̇ = −ω<sub>in</sub><sup>n</sup> × ψ + C<sub>b</sub><sup>n</sup> ε<sub>b</sub> − C<sub>b</sub><sup>n</sup> δC<sub>n</sub><sup>b</sup> ω<sub>ib</sub><sup>b</sup>

速度误差方程与Phi角模型形式相近，但耦合项中φ被替换为ψ，且需注意ψ与φ之间满足φ = ψ + δθ的转换关系，δθ为位置误差引起的导航系旋转。实际工程中，若初始方位失准角超过1°，Psi角模型的线性化误差更小；若已完成高精度对准且误差角在角分级，两者精度相当，Phi角模型计算量略低。

四、误差随时间累积特性

惯导误差的累积并非线性均匀，而是呈现明显的阶段性。以典型AUV航速2 m/s、陀螺零偏1 °/h、加速度计零偏1 mg为例（示例假设参数，非实测）：

• 短时阶段（0～10 min）：姿态误差主要由初始对准残差和陀螺零偏积分主导，约0.1°～0.3°；速度误差以加速度计零偏积分为主，约0.1～0.3 m/s；位置误差尚小。
• 中时阶段（10～60 min）：姿态误差通过fⁿ×φ耦合进速度通道，速度误差出现明显的舒勒振荡（周期约84.4 min）与线性增长叠加；位置误差开始以二次曲线发散。
• 长时阶段（>1 h）：陀螺零偏引起的方位误差使航向缓慢偏转，速度误差中的常值分量经积分形成位置漂移，典型量级可达数百米至公里级，单纯惯导已无法满足AUV回收或地形匹配的定位需求。

这一特性说明：误差抑制不能只靠“提高器件精度”，而必须在误差尚未发散到不可观测之前引入外部约束。

五、误差抑制技术路线总览

从误差传播链可以看出，抑制手段必须作用在“误差源—传播通道—输出结果”三个环节上。工程上通常组合使用以下三类策略：

多源融合。以INS为基准，引入DVL提供速度观测、深度计提供垂向位置约束、磁罗经或航向参考提供方位观测，通过卡尔曼滤波将观测残差反馈到误差状态。关键在于观测矩阵H的构造要与误差状态一一对应：DVL速度观测对应δv，深度计对应δp的z分量，磁航向对应ψ的方位分量。融合频率通常取1～10 Hz，观测噪声阵R需按传感器实际噪声水平设置，避免“融合了但权重不对”。

零速修正。当AUV处于悬停、坐底或回收等待状态时，真实速度为零，可将δv作为观测量直接约束速度误差，进而通过协方差耦合抑制姿态与位置漂移。ZUPT的有效性取决于“零速”判定的可靠性，通常结合DVL底速、IMU比力方差和载体状态机综合判断，避免在低速航行时误触发。

外部观测辅助。USBL水声定位提供绝对位置观测，地形匹配提供位置修正，单信标方位观测提供航向约束。这类观测精度高但更新率低，适合作为长时段的“锚点”，与高频DVL/深度观测形成互补。实际部署时需注意观测时延补偿，USBL的声传播时延在百米量级可达数十毫秒，若直接使用会导致滤波发散。