3. 惯性导航系统（INS）工作原理入门
惯性导航系统（Inertial Navigation System，INS）是一种不依赖外部信号、完全依靠自身传感器推算位置、速度和姿态的自主导航方式。对水下DVL与惯导组合导航而言，INS是整套系统的“主心骨”：它提供连续、高频的姿态与速度基准，而DVL则负责在长时间航行中抑制INS的速度漂移。要理解两者如何配合，首先必须弄清楚INS内部到底在算什么、传感器输出代表什么。
一、INS的物理组成：IMU与计算单元
INS在硬件上可以清晰地分为两大部分：惯性测量单元（IMU）和导航计算单元。
IMU是感知层，核心是三个正交安装的陀螺仪和三个正交安装的加速度计，通常构成“三轴陀螺+三轴加表”的六自由度测量组合。陀螺仪测量的是载体相对于惯性空间的角速度，单位一般为°/s或rad/s；加速度计测量的是载体所受的比力（specific force），单位一般为m/s²或g。这里要特别注意：加速度计输出的并不是载体的运动加速度，而是比力——即除引力之外所有外力产生的加速度，这也是后文比力方程要专门处理重力项的原因。
计算单元是解算层，通常是一块嵌入式处理器或导航计算机，负责完成三件事：姿态更新、速度更新、位置更新。它接收IMU的原始角速度和比力数据，结合初始对准得到的初始姿态、初始速度和初始位置，通过积分运算一步步推算出当前导航状态。IMU决定“测得多准”，计算单元决定“算得多快、多稳”，两者缺一不可。
二、陀螺仪输出与姿态更新
姿态描述的是载体坐标系相对导航坐标系（如当地水平坐标系“东-北-天”）的旋转关系。陀螺仪输出的角速度是载体相对惯性空间的转动速率，姿态更新本质上就是对角速度做时间积分，得到姿态角的变化量，再叠加到上一时刻的姿态上。
工程上常用四元数或方向余弦矩阵来做姿态更新，避免欧拉角在俯仰接近±90°时的奇异问题。以四元数为例，若采样周期为Δt，角速度为ω，则姿态四元数的更新可近似写为：
Δθ = ω · Δt // 角增量
q(k) = q(k-1) ⊗ Δq(Δθ) // 四元数乘法更新
C_b^n = quat2dcm(q(k)) // 转换为方向余弦矩阵这里q(k-1)是上一时刻姿态四元数，Δq是由角增量构造的增量四元数，⊗表示四元数乘法。得到的C_b^n就是载体到导航系的姿态转换矩阵，后续速度更新要用它把比力从载体坐标系转到导航坐标系。需要强调的是，陀螺仪存在零偏，积分会随时间累积成姿态漂移——这正是纯INS长时间航行后航向逐渐跑偏的根本原因，也是组合导航必须引入DVL等外部观测的动机。
三、比力方程与速度更新
加速度计测的是比力f^b（载体坐标系下）。要得到导航系下的速度，必须先把比力转到导航系，再扣除重力影响，并补偿地球自转和载体运动带来的哥氏项。完整比力方程可写为：
v̇^n = C_b^n · f^b − (2ω_ie^n + ω_en^n) × v^n + g^n其中v^n是导航系速度，C_b^n·f^b是比力在导航系的投影，(2ω_ie^n + ω_en^n)×v^n是哥氏加速度与向心加速度修正项，g^n是重力加速度。对水下低速、短航程场景，哥氏项量级较小，工程实现中常做简化，但重力项绝不能省——因为加速度计静止时输出约+1g的比力，若不扣除重力，积分出的速度会迅速发散。
举个教学示例（数值为合理假设，非实测）：设载体以0.5 m/s匀速直航，加速度计在载体前向测得比力约0.02 m/s²（含微小倾斜投影），采样周期10 ms。若姿态矩阵正确、重力补偿准确，则每个周期速度增量约0.0002 m/s，积分后速度稳定在0.5 m/s附近；若航向角有1°误差，前向比力会被错误投影到横向，横向速度将以约0.00035 m/s每周期累积，几十秒后横向速度误差就可达厘米每秒量级，位置误差随之扩大。这说明姿态精度直接决定速度解算精度，姿态与速度是强耦合的。
四、位置更新与误差累积
位置更新最为直接：把导航系速度对时间积分，得到位置变化量，再叠加到上一时刻位置。水平方向得到经纬度或东向/北向位移，垂直方向结合深度计或压力传感器得到深度。由于速度是由比力二次积分而来，加速度计的零偏会先积成速度误差（随时间线性增长），再积成位置误差（随时间平方增长），因此纯INS的位置误差随时间发散很快，这也是水下组合导航必须以DVL速度作为观测量进行校正的核心逻辑。