4. 惯导机械编排与初始对准

惯导系统能输出姿态、速度和位置，靠的不是某一时刻的测量值，而是把陀螺仪测得的角速度、加速度计测得的比力，按严格的数学关系持续“推演”下去。这套推演过程称为机械编排（Mechanization）。对AUV而言，机械编排决定了载体在无外界参考时能自主推算多久；初始对准则决定了推演的起点是否正确。两者共同构成惯导解算的核心。

姿态矩阵更新：从角速度到姿态

姿态矩阵（常记为 C_b^n）描述载体坐标系相对导航坐标系的方位关系。本节约定：导航坐标系取当地水平指北系（北-东-地，NED），载体坐标系取右-前-上（RFU），姿态角按航向、纵摇、横滚顺序定义。姿态更新本质是求解矩阵微分方程：

C_b^n(k+1) = C_b^n(k) · ΔC

其中 ΔC 由陀螺输出的角增量经旋转矢量法构造。工程上常用等效旋转矢量补偿圆锥误差：在一个采样周期内，把角速度积分成角增量 Δθ，再用 Δθ 与前一周期角增量叉乘项修正，得到等效旋转矢量 φ，最后用罗德里格斯公式生成 ΔC。采样周期通常取5～10 ms，AUV低速运动时圆锥效应不显著，但若推进器振动引起高频角振动，仍应保留二子样或三子样补偿。

需要特别注意的是，姿态矩阵更新必须扣除导航坐标系相对惯性空间的转动，即地球自转角速度 ω_ie 与载体在地球表面运动引起的牵连角速度 ω_en。AUV航速低（典型1～2 m/s），ω_en 量级很小，但长时间航行时若完全忽略，航向会缓慢漂移。实际实现中通常把 ω_ie + ω_en 投影到载体坐标系后从陀螺输出中扣除，再参与更新。

速度与位置解算

速度解算的核心是把加速度计测得的比力 f^b 变换到导航系，加上重力与哥氏项修正：

v̇^n = C_b^n · f^b − (2ω_ie^n + ω_en^n) × v^n + g^n

离散实现时，先做速度增量计算，再做位置积分。位置更新常用一阶或二阶积分：纬度 L、经度 λ、深度 h 分别由北向、东向、地向速度积分得到。AUV的深度通道通常由深度计直接观测，惯导深度通道更多作为备份或用于组合滤波。速度解算中重力模型不可省略，常用正常重力公式随纬度变化修正，若忽略，长航时会产生沿航向的加速度偏差累积。

实际工程中，纯惯导的速度误差随时间近似按 t 增长、位置误差按 t² 增长，姿态误差则受舒勒振荡调制。这意味着机械编排的精度不仅取决于器件零偏，也取决于初始对准给出的初始姿态和初始速度是否准确。

静基座与动基座初始对准

初始对准的任务是确定初始姿态矩阵和初始速度。静基座对准利用重力矢量与地球自转角速度矢量作为参考：加速度计测得的比力在静止时指向天向，可确定水平姿态（纵摇、横滚）；陀螺测得的角速度在导航系中的北向分量即 ω_ie·cosL，可确定航向。解析对准直接由这两个矢量叉乘构造姿态矩阵，速度快但受器件噪声影响大；精对准则用卡尔曼滤波估计失准角，通常需要数分钟，水平精度可达角分级，航向精度受陀螺零偏限制。

动基座对准面对的是载体存在线运动和角运动的情况。AUV在水下无法静止，常用方法是利用DVL提供的速度信息辅助，把速度误差作为观测量，通过卡尔曼滤波同时估计失准角和器件零偏。其基本思路是：以惯导推算速度与DVL速度之差作为量测，构建以失准角、速度误差、陀螺零偏、加速度计零偏为状态量的滤波器，在载体机动过程中逐步收敛。动基座对准的关键是载体需要有足够的机动激励，使不同方向的失准角可观测；若AUV直线匀速航行，航向失准角的可观测性会明显下降。

对准精度影响因素

对准精度直接决定后续纯惯导推算的误差起点。主要影响因素可归为四类。第一是器件误差：陀螺零偏直接限制航向对准精度，粗略估算航向误差约为陀螺零偏除以地球自转角速度水平分量，若零偏为0.01°/h，理论航向精度约在角分量级；加速度计零偏则影响水平对准。第二是对准时间：精对准滤波需要足够时间收敛，时间过短则失准角估计未稳定。第三是参考信息质量：动基座对准依赖DVL速度精度，若DVL存在刻度因数误差或底跟踪失锁，滤波会引入错误修正。第四是载体机动：适当的航向机动可提升航向失准角可观测性，但剧烈振动会恶化陀螺输出。

实际调试时，可先做静基座对准并记录失准角收敛曲线，观察水平失准角是否在1～2分钟内收敛到0.05°以内、航向是否稳定；再切换到动基座模式，用DVL辅助，检查速度残差是否收敛到DVL噪声水平。若航向残差持续偏大，应优先排查陀螺零偏标定和DVL安装角误差，而不是盲目延长对准时间。