4. 坐标系与转换

GNSS与INS紧耦合的核心在于将两套异构传感器的观测值统一到同一数学框架下进行融合。GNSS提供的是地心地固系（ECEF）下的位置与速度，而INS（惯性导航系统）通过陀螺仪和加速度计积分得到的是载体坐标系（b系）相对于惯性空间的角速度和比力。要实现紧耦合，必须清晰定义各坐标系之间的几何关系，并掌握姿态表示方法（欧拉角、四元数、旋转矩阵）的数学表达与转换规则。本章将系统梳理这些坐标系的定义、姿态参数化方法及其相互转换流程，为后续的误差方程推导和滤波融合奠定基础。

4.1 核心坐标系定义与物理意义

在GNSS/INS紧耦合系统中，坐标系的选择直接影响观测方程的建立和误差传播特性。工程实践中主要涉及三个核心坐标系：地心地固系（ECEF，Earth-Centered Earth-Fixed）、当地水平系（n系，通常取NED或ENU）以及载体坐标系（b系，通常与IMU固连）。ECEF系以地球质心为原点，Z轴指向协议地极（CIO），X轴指向本初子午线与赤道交点，Y轴按右手定则确定，该坐标系随地球自转，是GNSS卫星位置和接收机位置的自然参考框架。当地水平系的原点位于载体质心，NED（北东地）或ENU（东北天）的轴向定义取决于应用场景——航空惯导多采用NED，而机器人或自动驾驶领域更常用ENU。载体坐标系与IMU的敏感轴对齐，其原点通常定义在IMU测量中心，轴向遵循“右前上”或“右前下”约定，具体取决于IMU的安装方向。

理解这三个坐标系的关系是紧耦合融合的前提：GNSS输出的位置（经纬高）本质上是在ECEF系下的直角坐标（X,Y,Z）或大地坐标（L,B,H）表达；INS通过陀螺仪和加速度计在b系中测量角速度和比力，经过姿态矩阵变换到n系后，才能进行导航解算。因此，坐标系转换的精度直接决定了融合算法的性能上限。

4.2 姿态表示方法：欧拉角、四元数与旋转矩阵

姿态描述的是b系相对于n系的旋转关系，工程中常用的三种数学表达各有优劣。欧拉角通过三个依次旋转的角度（横滚角φ、俯仰角θ、航向角ψ）描述姿态，物理意义直观，便于人机交互和初始对准，但其核心缺陷是存在万向节锁问题——当俯仰角接近±90°时，横滚和航向的旋转轴重合，导致自由度丢失，无法唯一表示姿态。四元数采用四个参数（一个实部加三个虚部）表示旋转，避免了奇异性，且计算效率高（仅需乘加运算），非常适合在卡尔曼滤波中作为状态量进行递推，但需要满足单位模长约束，否则会产生漂移。旋转矩阵（方向余弦矩阵，DCM）是一个3×3的正交矩阵，其列向量表示b系各轴在n系中的投影，物理意义清晰，适用于向量坐标变换，但参数冗余（9个元素），在滤波更新后需要正交化处理以保持其正交性。

4.3 坐标系转换流程与实现方法

紧耦合融合中，坐标系转换主要包含三个层次：ECEF与n系之间的转换、n系与b系之间的姿态转换、以及ECEF与大地坐标（经纬高）之间的转换。ECEF到n系的转换矩阵C_e^n由载体所在位置的纬度和经度决定，其表达式为：

C_e^n = [-sin(L)  -sin(λ)cos(L)  cos(λ)cos(L);
          -cos(L)  -sin(λ)sin(L)  cos(λ)sin(L);
           0        cos(λ)         sin(λ)      ]

其中L为地理纬度，λ为经度。该矩阵将ECEF下的向量旋转到当地水平系。n系到b系的姿态转换则通过姿态矩阵C_b^n实现，该矩阵可由欧拉角、四元数或旋转矩阵相互转换得到。例如，从四元数q=(q0,q1,q2,q3)构造旋转矩阵的公式为：

C_b^n = [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²)]

在实际工程中，通常采用四元数作为滤波状态量进行递推，在需要输出或进行向量变换时再转换为旋转矩阵或欧拉角。ECEF与经纬高的转换涉及椭球模型（如WGS-84），需要迭代计算或使用封闭公式，在紧耦合中通常将GNSS的经纬高观测转换为ECEF直角坐标，以便与INS的ECEF位置预测值直接做差。

4.4 案例拆解：车载组合导航中的坐标系转换实现

以某车载GNSS/INS紧耦合系统为例，系统采用NED当地水平系，IMU安装时b系定义为“右前上”（X-右，Y-前，Z-上）。初始对准时，车辆静止，通过加速度计测量重力方向确定俯仰和横滚角，通过GNSS双天线测向或磁力计确定航向角，得到初始欧拉角（φ₀=0.5°, θ₀=-1.2°, ψ₀=135.7°）。随后将欧拉角转换为四元数作为滤波初值：

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

车辆行驶过程中，GNSS输出经纬高（L=31.2304°, λ=121.4737°, h=4.2m），系统将其转换为ECEF坐标（X=-2831753.8, Y=4659745.1, Z=3283540.6），同时INS通过姿态矩阵将b系下的加速度转换到n系，经过积分得到n系下的位置增量，再转换到ECEF系与GNSS观测值做差。在紧耦合滤波器中，量测方程直接使用ECEF坐标差，避免了经纬高非线性带来的线性化误差。实际测试中，由于坐标系转换引入的误差小于0.01m，对最终定位精度的影响可忽略，但若忽略地球曲率或椭球参数不匹配，则会产生米级误差。

4.5 常见误区与总结复盘

在坐标系与姿态转换的实际应用中，工程师常犯的错误包括：一是混淆NED与ENU的轴向定义，导致姿态矩阵符号错误，表现为航向角偏差180°或俯仰角符号反转；二是四元数未归一化，在长时间递推后模长漂移，导致姿态误差累积；三是欧拉角与四元数转换时未注意旋转顺序（如Z-Y-X与Z-X-Y），导致转换结果不一致；四是忽略地球自转和科里奥利效应在ECEF与n系转换中的影响，在高速或高动态场景下产生显著误差。

复盘建议：在系统集成前，编写坐标系转换的单元测试用例，使用已知姿态和位置数据验证转换函数的正确性；在滤波器中定期对四元数进行归一化处理；在GNSS/INS融合前，通过静态测试和动态测试对比转换前后的位置、速度一致性。掌握坐标系转换的本质——即向量在不同参考框架下的投影关系，是理解紧耦合算法的基础，也是排查融合异常的关键切入点。