坐标系基础：惯性系、地球系、导航系、载体系的定义与转换关系，以及姿态矩阵在速度积分中的作用

捷联惯导系统（SINS）的核心任务是通过测量载体自身的角速度与比力，在已知初始条件的前提下，递推解算出载体的位置、速度和姿态。这一过程的数学基础，首先依赖于对“参考空间”的严格定义。在惯导解算中，我们并非在空间中进行矢量运算，而是在一系列人为定义的坐标系中描述物理量。若坐标系定义不清或转换关系混乱，后续所有积分运算都将失去物理意义。本节将系统梳理惯导解算中四个核心坐标系——惯性系（i系）、地球系（e系）、导航系（n系）与载体系（b系）——的几何定义、相互转换关系，并重点剖析姿态矩阵（方向余弦矩阵）如何作为“桥梁”，将加速度计测量的比力从载体系投影到导航系，从而完成速度积分的第一步。

上图展示了四个坐标系之间的空间关系以及姿态矩阵在速度积分链路中的核心位置。从工程实现角度看，坐标系的定义并非纯粹的数学游戏，而是直接决定了传感器数据融合的方式、误差补偿模型的建立以及最终导航参数的物理含义。下面我们将逐一深入剖析每个坐标系的定义要点，并详细推导转换关系，最后通过一个具体案例说明姿态矩阵误差对速度积分精度的实际影响。

2.1 惯性系（i系）与地球系（e系）的定义及转换

核心原理：惯性系是理想化的参考系，其原点位于地心，三轴指向空间中的固定恒星（如春分点方向）。在该坐标系中，牛顿第二定律以最简单的形式成立：F = m·a，无需考虑任何虚拟力。地球系（e系）的原点同样位于地心，但其Z轴与地球自转轴重合，X轴指向本初子午线与赤道的交点，Y轴按右手定则确定。e系相对于i系以地球自转角速度（约 7.292115×10⁻⁵ rad/s）绕Z轴旋转。

判断方法与工程要点：在实际惯导解算中，我们无法直接获得i系下的物理量，但陀螺仪测量的角速度是相对于i系的（即 ω_ib^b，表示b系相对于i系的角速度在b系中的投影）。因此，理解i系与e系的转换关系，是计算地球自转引起的哥氏加速度补偿项的基础。e系到i系的转换矩阵 C_e^i 是一个绕Z轴的旋转矩阵，旋转角为 ω_ie · Δt（其中 ω_ie 为地球自转角速率，Δt 为时间间隔）。

2.2 导航系（n系）与载体系（b系）的定义及姿态矩阵

核心原理：导航系（n系）是捷联惯导解算中输出导航参数的参考系，通常采用“北-东-地”（NED）坐标系。其原点位于载体当前所在位置，X轴指向地理北向，Y轴指向东向，Z轴垂直于地球表面指向地心。载体系（b系）则与IMU（惯性测量单元）固连，其X轴指向载体右方，Y轴指向前方，Z轴指向上方（即“右-前-上”）。陀螺仪和加速度计直接测量得到的数据均是在b系中表达的。

姿态矩阵 C_b^n 的定义：姿态矩阵（方向余弦矩阵）描述了b系相对于n系的旋转关系，其数学定义为：

C_b^n = [cos(ψ)cos(θ)  sin(ψ)cos(θ)  -sin(θ);
         cos(ψ)sin(θ)sin(φ)-sin(ψ)cos(φ)  sin(ψ)sin(θ)sin(φ)+cos(ψ)cos(φ)  cos(θ)sin(φ);
         cos(ψ)sin(θ)cos(φ)+sin(ψ)sin(φ)  sin(ψ)sin(θ)cos(φ)-cos(ψ)sin(φ)  cos(θ)cos(φ)]

其中，ψ（航向角）、θ（俯仰角）、φ（横滚角）为欧拉角。该矩阵是正交矩阵，满足 (C_b^n)⁻¹ = (C_b^n)ᵀ = C_n^b。姿态矩阵的核心作用在于将加速度计测量的比力矢量从b系投影到n系：

f_n = C_b^n · f_b

这一投影是速度积分的第一步，其精度直接影响后续速度与位置解算的准确性。

2.3 姿态矩阵在速度积分中的具体作用与实现流程

操作流程：在捷联惯导解算中，速度更新的标准流程如下：

1. 姿态更新：利用陀螺仪输出的角增量 Δθ，通过四元数或等效旋转矢量更新姿态矩阵 C_b^n。这一步确定了当前时刻的姿态。
2. 比力投影：将加速度计输出的比力增量 Δv_b 乘以姿态矩阵 C_b^n，得到n系下的比力增量 Δv_n = C_b^n · Δv_b。
3. 有害加速度补偿：在n系下，需要扣除哥氏加速度、离心加速度以及重力加速度的影响。具体公式为：

v_n(t+Δt) = v_n(t) + [C_b^n · f_b - (2·ω_ie_n + ω_en_n) × v_n + g_n] · Δt

其中，ω_ie_n 为地球自转角速度在n系中的投影，ω_en_n 为n系相对e系的旋转角速度（由载体运动引起），g_n 为重力加速度在n系中的投影。

2.4 案例拆解：姿态误差对速度积分的影响分析

案例背景：某无人机搭载捷联惯导系统，飞行前在地面进行静态对准。初始对准完成后，系统输出姿态角为：航向角 ψ = 30°，俯仰角 θ = 0°，横滚角 φ = 0°。但实际由于对准算法残留误差，真实俯仰角为 θ_true = 0.05°（即存在 0.05° 的俯仰误差）。无人机随后以 20 m/s 的速度水平飞行 100 秒。

分析过程：在水平飞行阶段，加速度计测量的比力主要为重力分量。由于姿态误差的存在，投影到n系后，水平方向将产生虚假的加速度分量：

a_error = g · sin(0.05°) ≈ 9.8 × 0.000873 ≈ 0.00855 m/s²

该虚假加速度在 100 秒内累积的速度误差为：

Δv = a_error × t = 0.00855 × 100 = 0.855 m/s

对应的位置误差为：

Δs = 0.5 × a_error × t² = 0.5 × 0.00855 × 10000 = 42.75 m

实际操作与结果：在仿真中，我们分别使用理想姿态矩阵和含 0.05° 俯仰误差的姿态矩阵进行速度积分。结果显示，100 秒后水平位置误差达到 42.8 米，与理论计算一致。若飞行时间延长至 10 分钟（600 秒），位置误差将增长至约 1.54 公里，完全无法满足导航需求。

复盘与经验：该案例表明，姿态矩阵的微小误差会通过积分过程被放大为显著的位置漂移。因此，在系统设计时，必须保证初始对准精度，并在飞行过程中通过组合导航（如GNSS/INS）对姿态误差进行在线估计与修正。同时，速度积分算法中应尽量采用高精度的数值积分方法（如四阶龙格-库塔法），以减小积分截断误差。