3. 惯性导航系统（INS）原理与误差源分析

惯性导航系统是AUV自主定位的核心，它不依赖任何外部信号，仅靠自身携带的惯性传感器测量运动信息并递推位置。理解INS的工作原理与误差来源，是后续进行多源融合和误差抑制的前提。本节从传感器机理出发，逐步展开机械编排方程，再系统梳理误差源及其对定位的影响。

一、陀螺仪与加速度计的工作原理

惯性导航依赖两类传感器：陀螺仪测量载体相对惯性空间的角速度，加速度计测量载体所受的比力（非引力加速度）。两者配合，才能完整描述载体的运动状态。

陀螺仪的核心任务是跟踪姿态变化。以常用的光纤陀螺（FOG）为例，它利用Sagnac效应：两束光在闭合光纤环中沿相反方向传播，当环体绕敏感轴旋转时，两束光的光程差与角速度成正比，通过干涉条纹的相位差即可解算出角速度。MEMS陀螺则利用科里奥利力使振动质量块产生与角速度相关的位移。陀螺输出的是角速度 ω，积分后得到姿态角变化。

加速度计测量的是比力 f，即载体所受非引力外力与质量的比值。静止时加速度计输出为重力加速度的反作用（比力约等于 −g 在敏感轴上的投影），自由落体时输出为零。因此加速度计不能直接给出运动加速度，必须结合姿态信息扣除重力分量，才能得到真正的运动加速度。这一细节是理解INS机械编排的关键。

二、INS机械编排方程

机械编排（Mechanization）是把传感器原始测量递推为位置、速度、姿态的数学框架。在导航坐标系（取当地水平东北天ENU系）下，核心方程可概括为三组：

• 姿态方程：姿态矩阵 C_b^n 的更新由陀螺角速度减去导航系相对惯性系的旋转（地球自转与载体在地球表面运动引起的旋转）后积分得到。
• 速度方程：v̇^n = C_b^n · f^b − (2ω_ie^n + ω_en^n) × v^n + g^n。其中 C_b^n·f^b 把比力投影到导航系，哥氏项与向心项补偿地球旋转和载体运动的影响，g^n 为重力矢量。
• 位置方程：纬度、经度、高度由速度积分得到，纬度变化率与北向速度相关，经度变化率与东向速度及纬度相关。

实际实现中，上述连续方程需离散化。以姿态更新为例，常用四元数法避免万向节死锁，在每个采样周期 Δt 内用角增量构造旋转四元数并做乘法更新。速度与位置则采用一阶或二阶积分。采样率通常为100～400 Hz，而融合输出可能降到10～50 Hz。

三、传感器误差分类

INS误差可分为传感器误差、初始对准误差和算法/环境误差三大类。传感器误差是最主要的误差源，可细分为：

其中零偏影响最为深远。以陀螺零偏为例，若零偏为 0.1 °/h，则1小时后姿态误差约0.1°，由此产生的水平加速度误差约为 g·sin(0.1°) ≈ 0.0017 m/s²，积分1小时后速度误差约6 m/s，位置误差可达上万米量级。这解释了为何纯INS在长时间航行中必须依靠外部观测校正。

随机噪声则决定了INS的短期平滑度。角度随机游走（ARW）使姿态误差按 √t 增长，速度随机游走（VRW）使速度误差按 √t 增长。工程上常通过Allan方差分析辨识这些噪声系数，用于滤波器建模。

四、初始对准误差的影响

初始对准的任务是确定初始姿态矩阵，通常分为粗对准和精对准。粗对准利用重力矢量和地球自转角速度确定水平与方位；精对准则通过卡尔曼滤波进一步收敛。对准误差主要体现为：

• 水平失准角：使重力在水平方向产生虚假分量，直接引入加速度误差，导致速度与位置漂移。
• 方位失准角：使东向/北向速度投影发生旋转耦合，在载体运动时产生交叉误差。

以方位失准角 0.5° 为例，当AUV以1 m/s航行时，速度投影误差约 1×sin(0.5°) ≈ 0.0087 m/s，看似很小，但持续积分后位置误差会线性累积。因此高精度INS对初始对准的方位精度要求往往在0.1°以内。

五、误差对定位的综合影响与工程判断

把上述误差放在一起看，纯INS的定位误差随时间呈发散趋势：短期由随机噪声主导，中期由零偏和标度因数主导，长期则由初始对准误差和零偏共同决定。工程上常用“位置误差增长率”来快速评估INS性能，例如某型INS标称1小时位置误差不超过1海里（约1852 m），即可反推其等效陀螺零偏水平。

在实际AUV任务中，判断INS是否“够用”需要结合任务时长和精度要求。若任务为2小时、要求定位误差小于500 m，则需选择零偏更低的陀螺或缩短外部校正间隔。这也正是后续章节引入DVL、USBL等外部观测进行融合校正的直接动因——用外部观测约束INS的发散，用INS提供高频平滑输出，二者互补。

总结来看，INS的原理清晰但误差机理复杂：传感器零偏和初始对准误差是系统性误差的主因，随机噪声决定短期品质，标度因数和安装误差在机动时放大。掌握这些误差的传播规律，才能在融合算法中合理设置噪声矩阵和校正策略，实现有效的误差抑制。