导航定位基础：坐标系、地球模型、时间系统、导航常用术语

导航定位的本质是求解“载体在什么时刻、处于什么位置、朝向何方”的问题。要回答这个问题，必须首先建立统一的数学与物理基准：用坐标系描述位置与姿态，用地球模型近似真实地球的几何与引力特性，用时间系统同步观测与解算，用导航术语精确表达误差、精度与工作模式。GPS与IMU融合导航的所有算法——包括惯性机械编排、卡尔曼滤波、误差补偿——都建立在这些基础概念之上。若坐标系定义混乱、地球模型选择不当或时间基准不同步，后续的融合解算将产生系统性偏差，且难以通过滤波收敛消除。

上图展示了本章四个核心模块之间的逻辑关系：坐标系、地球模型、时间系统与导航术语共同构成融合导航的输入基准，经过GPS与IMU融合解算后输出位置、速度、姿态与时间。下面逐一深入展开。

2.1 坐标系：从地心到载体的空间基准

核心原理

导航解算中涉及多个坐标系，每个坐标系都有明确的定义与用途。最常用的包括：

• ECEF（地心地固坐标系）：原点在地球质心，Z轴指向协议地球极（CTP），X轴指向本初子午线与赤道交点，Y轴按右手定则确定。GPS卫星位置、接收机位置通常用ECEF表示。
• LLA（经纬高坐标系）：基于椭球面定义纬度φ、经度λ和椭球高h，是用户最直观的位置表达方式。
• NED（北东地导航坐标系）：原点在载体所在位置，X轴指向北、Y轴指向东、Z轴指向地心方向。IMU输出的加速度和角速度通常投影到NED系进行机械编排。
• 机体坐标系（b系）：固连于载体，X轴指向机头（或前向）、Y轴指向右翼、Z轴指向下。IMU直接测量的是b系下的比力和角速度。

判断方法与操作流程

在实际融合算法中，坐标转换是高频操作。核心流程为：

1. 将IMU输出的b系比力通过姿态矩阵旋转到NED系；
2. 在NED系下进行速度积分与位置更新；
3. 将NED位置转换为LLA或ECEF，与GPS观测值对齐；
4. 滤波更新后，再将修正量反馈到姿态矩阵与位置状态。

姿态角定义遵循Z-Y-X欧拉角顺序：航向角ψ（绕Z轴）、俯仰角θ（绕Y轴）、横滚角φ（绕X轴）。转换矩阵为：

C_n_b = Rz(ψ) * Ry(θ) * Rx(φ)

案例拆解：坐标系混用导致的定位跳变

某无人机在GPS信号良好时位置输出正常，但切换至纯惯性导航后位置漂移异常。排查发现：IMU机械编排在NED系下进行，但初始姿态矩阵误用了ECEF系下的GPS速度作为参考，导致初始失准角约2°。在10秒纯惯性导航后，水平位置误差达到约15米。修正方法：将GPS速度转换至NED系，并重新初始化姿态矩阵，误差降至0.5米以内。

常见误区与总结

• 误区1：将ECEF位置直接当作NED位置使用——两者原点不同，差一个平移量。
• 误区2：忽略地球曲率，在小范围近似平面时未补偿科里奥利项。
• 误区3：姿态角定义顺序混淆，导致旋转矩阵转置错误。

2.2 地球模型：WGS-84椭球与重力场

核心原理

GPS系统采用WGS-84地球模型，其定义参数为：长半轴a=6378137米，扁率f=1/298.257223563。该椭球面是GPS高程的参考面。在导航解算中，需要计算两个关键曲率半径：

• 卯酉圈曲率半径（东西方向）：Rn = a / sqrt(1 - e²·sin²φ)
• 子午圈曲率半径（南北方向）：Re = a·(1-e²) / (1 - e²·sin²φ)^(3/2)

重力模型通常采用正常重力公式，并考虑高度修正。IMU加速度计测量的是比力（Specific Force），即载体加速度与重力加速度之差，因此必须从比力中扣除重力向量才能得到运动加速度。

操作流程：从ECEF到LLA的转换

输入: x, y, z (ECEF)
1. 计算经度 λ = atan2(y, x)
2. 迭代计算纬度 φ:
   p = sqrt(x² + y²)
   φ0 = atan2(z, p·(1-e²))
   迭代: φ = atan2(z + e²·Rn·sin(φ), p)
3. 计算椭球高 h = p/cos(φ) - Rn
输出: φ, λ, h

案例拆解：高程异常对融合定位的影响

某车载导航系统在山区测试时，GPS高程与气压高度计差异达40米。分析发现：GPS高程是相对于WGS-84椭球面的椭球高，而气压高度计测量的是正高（相对于大地水准面）。两者之间存在高程异常（大地水准面差距），在山区可达30-50米。融合算法中若未区分这两种高程基准，会导致垂直通道滤波发散。解决方案：在融合前将GPS椭球高转换为正高，或引入高程异常模型进行补偿。

常见误区与总结

• 误区1：将地球视为球体，忽略扁率影响。在中纬度地区，球体近似可导致约20公里的位置误差。
• 误区2：重力模型使用常数g=9.8，未考虑纬度与高度变化。在万米高空，重力变化可达0.3%。
• 误区3：曲率半径计算错误，导致经纬度增量与距离转换不准确。

2.3 时间系统：GPS时、UTC与时间同步

核心原理

GPS系统使用GPS时（GPST），起点为1980年1月6日0时（UTC）。GPST是连续时间系统，不包含闰秒。而UTC（协调世界时）包含闰秒，目前GPST与UTC相差18秒（截至2024年）。在融合导航中，时间同步至关重要：

• GPS接收机输出位置、速度时带有GPST时间戳；
• IMU以固定频率（如100Hz）采样，需要精确的时间戳；
• 若GPS与IMU时间不同步，将导致位置与姿态的“时间错位”，在动态场景下产生显著误差。

操作流程：时间同步与插值

1. 将GPS时间戳转换为与IMU相同的时间基准（如转换为Unix时间戳或单调时钟）；
2. 检测GPS与IMU时间戳之间的延迟（通常通过硬件PPS脉冲或软件互相关）；
3. 对IMU数据进行时间插值，使其与GPS观测时刻对齐；
4. 在卡尔曼滤波中，将IMU状态预测到GPS观测时刻，再进行量测更新。

案例拆解：时间延迟导致的转弯误差

某车辆测试中，GPS更新率为10Hz，IMU为100Hz。由于接收机内部处理延迟，GPS时间戳比实际观测时刻晚50ms。在车辆以20m/s速度行驶并转弯时，50ms的时间误差导致位置偏差约1米，且航向角误差增大。通过硬件PPS脉冲校准，将时间延迟补偿至5ms以内，定位精度恢复至厘米级。

常见误区与总结

• 误区1：忽略闰秒影响，将GPST直接当作UTC使用，导致时间标签错误。
• 误区2：未考虑GPS接收机内部延迟，仅依赖时间戳进行同步。
• 误区3：在滤波更新时，未将IMU状态传播到GPS观测时刻，而是直接使用最近时刻的IMU状态。

2.4 导航常用术语：精度、误差与工作模式

核心原理

导航领域有一套标准术语用于描述系统性能与误差特性。理解这些术语是评估融合算法效果的前提。

判断方法与操作流程

在实际工程中，选择组合模式需考虑：

1. 载体动态特性：高动态（导弹、无人机）优先紧/深组合；
2. GPS信号质量：城市峡谷或遮挡环境，紧组合可提供部分导航能力；
3. 计算资源：深组合需要更高算力与更复杂的硬件接口。

案例拆解：松组合与紧组合的精度对比

某城市物流无人机在楼宇间飞行，GPS信号频繁遮挡。松组合模式下，当GPS信号丢失时，纯惯性导航位置漂移约50米/分钟；紧组合模式下，利用部分可见卫星的伪距信息，位置漂移降至15米/分钟。进一步采用深组合，在信号遮挡前提前调整跟踪环路带宽，漂移降至5米/分钟。该案例表明，组合模式的选择直接影响系统在复杂环境下的可用性。

常见误区与总结

• 误区1：混淆CEP与1σ。CEP约等于1.177倍的1σ（二维正态分布）。
• 误区2：忽略IMU零偏的温度依赖性。MEMS传感器零偏随温度变化可达数倍，需进行温度补偿。
• 误区3：认为组合模式越紧越好。实际上，深组合对硬件同步要求极高，若时间同步误差超过1ms，性能反而下降。