2、捷联惯导基础：坐标系定义与姿态表示方法

捷联惯导系统（SINS）的核心任务是通过惯性传感器（陀螺仪和加速度计）的测量值，实时解算出运载体相对于导航参考系的姿态、速度和位置。而这一切的起点，是精确的坐标系定义和姿态描述方法。如果坐标系定义混乱或姿态转换关系错误，后续的初始对准、误差补偿和导航解算将毫无意义。本章将系统梳理惯性导航中四大核心坐标系（惯性系、地球系、导航系、载体系）的定义与物理含义，深入对比欧拉角、方向余弦矩阵（DCM）和四元数三种姿态表示方法的数学本质、工程适用场景及相互转换关系，为后续章节的初始对准算法打下坚实的数学与物理基础。

2.1 四大坐标系的物理定义与工程含义

在捷联惯导系统中，坐标系的选择直接决定了传感器测量值的投影方向和导航解算的参考基准。理解每个坐标系的物理本质，是正确建立姿态转换关系的前提。

2.1.1 惯性坐标系（i系）

惯性坐标系是牛顿力学定律成立的参考系，理论上应是一个静止或匀速直线运动的坐标系。在工程实践中，我们通常采用地心惯性坐标系（ECI）：原点位于地球质心，Z轴沿地球自转轴指向北极，X轴指向春分点，Y轴按右手定则确定。该坐标系不随地球自转，是陀螺仪测量角速度的参考。需要特别注意的是，实际使用的惯性系并非严格惯性，但地球自转角速度（约15.04°/h）的长期漂移效应在导航解算中会通过哥里奥利项进行补偿。

2.1.2 地球坐标系（e系）

地球坐标系（ECEF）原点同样位于地心，但Z轴沿地球自转轴，X轴指向本初子午线与赤道的交点，整个坐标系随地球一起转动。该坐标系是描述载体经纬高位置的自然参考。在捷联惯导中，e系主要用于将导航系下的速度转换为地心地固系下的位置变化率，以及计算地球自转角速度在导航系中的投影分量。

2.1.3 导航坐标系（n系）

导航坐标系是捷联惯导解算速度和位置的直接参考系。工程中普遍采用当地水平坐标系，即原点位于载体质心，X轴指向东（E），Y轴指向北（N），Z轴指向天顶（U），构成ENU右手坐标系。另一种常见形式是北-东-地（NED）坐标系，主要用于航空领域。导航系的选取直接影响重力加速度的分解和哥里奥利项的计算形式。在初始对准中，n系是重力矢量g和地球自转角速度ωie投影的目标坐标系。

2.1.4 载体坐标系（b系）

载体坐标系与运载体固连，原点位于IMU测量中心，X轴指向载体右方，Y轴指向前方，Z轴指向上方（RFU），构成右手系。三个正交安装的陀螺仪和加速度计分别测量b系下的角速度和比力。载体坐标系与导航系之间的相对姿态关系，正是捷联惯导需要实时求解的核心量。

2.2 姿态表示方法：欧拉角、方向余弦矩阵与四元数

姿态描述的本质是建立载体系（b系）到导航系（n系）的坐标变换关系。三种主流方法各有优劣，工程中需根据计算精度、实时性和算法复杂度进行权衡。

2.2.1 欧拉角法

欧拉角通过三次基本旋转来描述姿态，常用的旋转顺序为Z-Y-X（航向-俯仰-横滚），对应的角度分别为ψ（航向角）、θ（俯仰角）、φ（横滚角）。从n系到b系的转换矩阵为：

C_n^b = Rz(ψ)·Ry(θ)·Rx(φ)
其中：
Rz(ψ) = [cosψ  sinψ  0; -sinψ  cosψ  0; 0  0  1]
Ry(θ) = [cosθ  0  -sinθ; 0  1  0; sinθ  0  cosθ]
Rx(φ) = [1  0  0; 0  cosφ  sinφ; 0  -sinφ  cosφ]

欧拉角的物理意义直观，便于飞行员或地面操作人员理解，但其存在万向节锁问题：当俯仰角θ接近±90°时，航向角与横滚角的旋转轴重合，导致自由度丢失，无法唯一确定姿态。因此，欧拉角法仅适用于水平姿态变化较小的场景（如地面车辆），不适用于战斗机或高机动飞行器。

2.2.2 方向余弦矩阵（DCM）法

方向余弦矩阵是一个3×3的正交矩阵，其9个元素分别表示b系各轴在n系各轴上的投影余弦值。DCM的更新方程为：

Ċ_n^b = C_n^b · [ω_nb^b ×]
其中[ω×]为角速度矢量的反对称矩阵

DCM法不存在奇异问题，且可以直接用于矢量坐标变换，但其包含9个微分方程，计算量较大，且需要周期性正交化处理以抑制数值漂移。在捷联惯导中，DCM通常作为中间转换量，用于将四元数转换为欧拉角输出。

2.2.3 四元数法

四元数是由一个标量和三个矢量分量组成的超复数，定义为q = [q0, q1, q2, q3]^T，满足q0²+q1²+q2²+q3²=1。四元数描述的是绕某一单位矢量旋转一定角度的等效旋转。其姿态更新微分方程为：

q̇ = 0.5 · q ⊗ [0, ω_nb^b]
其中⊗表示四元数乘法

四元数法仅需解算4个微分方程，计算量小，且不存在奇异问题，是捷联惯导系统中最常用的姿态表示方法。但四元数不直观，且必须进行归一化处理以保持单位范数约束。

2.3 三种姿态表示方法的转换关系

在实际系统中，通常采用四元数进行姿态更新，但需要将结果转换为欧拉角供显示或控制使用，同时需要DCM作为坐标变换的桥梁。因此，掌握三者之间的转换公式至关重要。

2.3.1 四元数 → 方向余弦矩阵

C_n^b = 
[1-2(q2²+q3²)   2(q1q2-q0q3)   2(q1q3+q0q2)]
[2(q1q2+q0q3)   1-2(q1²+q3²)   2(q2q3-q0q1)]
[2(q1q3-q0q2)   2(q2q3+q0q1)   1-2(q1²+q2²)]

2.3.2 方向余弦矩阵 → 欧拉角

ψ = atan2(C[0][1], C[0][0])
θ = asin(-C[0][2])
φ = atan2(C[1][2], C[2][2])

注意atan2函数需根据分子分母符号判断象限，避免角度跳变。

2.3.3 欧拉角 → 四元数

q0 = cos(ψ/2)cos(θ/2)cos(φ/2) + sin(ψ/2)sin(θ/2)sin(φ/2)
q1 = cos(ψ/2)cos(θ/2)sin(φ/2) - sin(ψ/2)sin(θ/2)cos(φ/2)
q2 = cos(ψ/2)sin(θ/2)cos(φ/2) + sin(ψ/2)cos(θ/2)sin(φ/2)
q3 = sin(ψ/2)cos(θ/2)cos(φ/2) - cos(ψ/2)sin(θ/2)sin(φ/2)

2.4 案例拆解：动基座对准中的姿态初始化

场景背景：某型舰载无人机在甲板滑跑起飞前需要进行快速初始对准，但舰船受海浪影响存在周期性的横摇和纵摇运动（幅度约±5°，周期约8秒），且甲板存在低频振动。要求对准时间不超过60秒，航向精度优于0.1°。

初始现象与约束：IMU输出的陀螺仪噪声为0.01°/√h，加速度计零偏为0.5mg。由于舰船晃动，直接使用加速度计测量重力方向会引入较大的水平失准角误差。

分析判断过程：传统静基座对准假设载体静止，通过加速度计测量重力方向确定水平姿态，通过陀螺仪测量地球自转角速度确定航向。但在动基座条件下，晃动加速度会污染比力测量，导致水平对准误差增大。因此需要采用多矢量定姿法：利用重力矢量在n系的投影g_n = [0,0,-g]^T和地球自转角速度在n系的投影ω_ie^n = [0, ω_ie·cos(L), ω_ie·sin(L)]^T（L为纬度），与b系中对应的测量值g_b和ω_ib^b构建双矢量定姿问题。

实际操作步骤：

1. 采集60秒IMU数据，对陀螺仪和加速度计输出进行滑动平均滤波，抑制晃动干扰。
2. 利用滤波后的加速度计输出计算水平姿态初值：θ₀ = asin(f_x/g)，φ₀ = -asin(f_y/g·cosθ)。
3. 利用滤波后的陀螺仪输出计算航向初值：ψ₀ = atan2(-ω_y·cosφ + ω_z·sinφ, ω_x·cosθ + ω_y·sinφ·sinθ + ω_z·cosφ·sinθ)，其中ω为地球自转角速度在b系的投影。
4. 将欧拉角初值转换为四元数，作为后续精对准的初始值。

结果对比：采用该方法后，水平失准角在10秒内收敛至0.01°以内，航向角在50秒内收敛至0.08°，满足指标要求。相比传统静基座对准（假设载体静止），航向对准时间缩短了40%，且抗晃动能力显著提升。

风险与代价：该方法对陀螺仪零偏稳定性要求较高，若陀螺仪零偏超过0.02°/h，航向对准误差将超过0.1°。此外，滤波器的截止频率需要根据晃动频率动态调整，过低会引入延迟，过高则无法有效抑制干扰。

2.5 常见误区与总结复盘

误区一：混淆坐标系定义。部分初学者将导航系直接等同于地球系，导致在计算哥里奥利项时遗漏地球自转分量。实际上，导航系是当地水平坐标系，其相对于地球系存在随经纬度变化的旋转角速度。

误区二：忽视四元数归一化。四元数微分方程在数值积分过程中会因截断误差导致范数偏离1，若不进行周期性归一化，姿态误差会随时间累积。工程中通常在每个计算周期（如100Hz）内进行一次归一化。

误区三：欧拉角转换的象限判断。使用atan2函数时，部分开发者误用atan，导致航向角在±180°边界处出现跳变。必须使用四象限反正切函数，并根据C矩阵元素符号进行象限修正。

误区四：动基座对准中直接使用加速度计输出。当载体存在线加速度时，加速度计测量的比力不再等于重力，直接使用会导致水平失准角偏大。必须通过频域滤波或状态估计方法分离重力分量。

本章系统梳理了捷联惯导的坐标系定义和姿态表示方法。在实际工程中，四元数因其计算高效、无奇异的优势成为姿态解算的核心，而欧拉角则作为人机交互的输出形式，方向余弦矩阵在坐标变换中起到桥梁作用。理解三者的数学本质和转换关系，是后续学习初始对准算法、误差传播分析和动基座对准技术的基础。建议读者在仿真环境中自行编写坐标转换代码，验证不同表示方法在极端姿态下的数值稳定性，以加深理解。