2. 导航基础
在轮速与IMU组合导航工程中，理解各类导航方式的基本原理及其坐标系定义，是后续算法设计、误差建模与系统集成的基石。本节将围绕惯性导航、航位推算、卫星导航与组合导航四条主线展开，并重点厘清工程中常用的坐标系及其转换关系。
一、核心原理：四种导航方式的分工与互补
惯性导航（INS）基于牛顿力学定律，利用陀螺仪测量角速度、加速度计测量比力，通过积分运算递推载体的姿态、速度和位置。其核心优势是自主性强、输出频率高、短时精度好，但积分过程会累积漂移，长时间导航误差随时间发散。
航位推算（DR）通过已知的起始位置，结合轮速传感器测得的行驶距离与航向角变化，递推车辆位置。轮速脉冲在低速和打滑工况下仍能提供较可靠的纵向位移信息，但航向依赖陀螺仪或磁力计，横向误差会随行驶距离累积。
卫星导航（GNSS）通过接收多颗卫星的伪距与多普勒观测值，解算接收机的绝对位置与速度。其特点是长期精度稳定、无累积误差，但易受城市峡谷、隧道、林荫遮挡影响，输出频率低（通常1～10Hz），且存在多路径与周跳问题。
组合导航将INS/DR与GNSS通过卡尔曼滤波等估计方法融合，利用GNSS的绝对观测抑制惯性漂移，同时利用INS/DR的高频输出在GNSS失锁时维持连续导航。轮速与IMU组合正是典型的DR/INS与GNSS融合架构中的核心子系统。
二、方法流程：从传感器到融合输出的数据链路
工程实现中，组合导航的数据链路通常按以下顺序组织：
- 传感器采集：IMU以100～1000Hz输出角速度与比力，轮速传感器以脉冲形式输出车轮转动信息，GNSS接收机以1～10Hz输出位置、速度与时间。
- 时间同步与坐标统一：将各传感器时间戳对齐到同一时基，并把轮速、IMU、GNSS观测统一到同一坐标系（通常为ENU或ECEF）。
- 惯性递推：利用IMU数据进行姿态更新、速度更新与位置更新，得到高频导航状态预测。
- 轮速辅助：将轮速换算为车体纵向速度，作为观测量约束INS速度误差，抑制纵向漂移。
- GNSS量测更新：当GNSS有效时，以位置/速度差作为卡尔曼滤波观测量，修正惯性累积误差。
- 反馈校正：将估计出的姿态、速度、位置及零偏误差反馈至惯性递推环节，形成闭环。
关键理解：组合导航不是简单地把两个结果取平均，而是通过误差状态模型，把GNSS的绝对观测与INS/DR的相对递推在概率框架下最优融合。轮速在其中扮演“纵向速度观测源”的角色，尤其在城市峡谷GNSS失锁时，轮速+IMU可维持数十秒的可用定位精度。
三、坐标系定义：工程中必须统一的“语言”
坐标系定义不清是组合导航工程中最常见的错误来源之一。以下为常用坐标系及其用途：
| 坐标系 | 英文/缩写 | 原点与轴向 | 典型用途 |
|---|---|---|---|
| 地心地固系 | ECEF | 原点在地心，X轴指向本初子午线与赤道交点，Z轴指向北极 | GNSS卫星轨道计算、全球统一坐标 |
| 东北天站心系 | ENU | 原点在载体所在点，X东、Y北、Z天 | 局部导航解算、组合导航滤波 |
| 大地坐标系 | LLA | 纬度、经度、海拔高度 | GNSS输出、地图匹配、人机界面 |
| 载体坐标系 | Body | 原点在IMU中心，X右、Y前、Z上（或前-右-下） | IMU原始输出、轮速安装方向定义 |
| 车辆坐标系 | Vehicle | 原点在后轴中心，X前、Y左、Z上 | 轮速与车辆运动学建模 |
工程提示：IMU安装后必须标定其相对车辆坐标系的安装角（横滚、俯仰、航向失准角）。轮速脉冲当量（每脉冲对应行驶距离）也需通过直线行驶标定获得。这些参数直接决定组合导航的初始对准精度。
四、案例与场景：城市峡谷中的组合导航表现
假设车辆在城市高楼间行驶，GNSS频繁失锁。此时系统行为如下：
- GNSS有效时：卡尔曼滤波以GNSS位置/速度更新，同时估计IMU零偏与轮速标度因数误差，定位精度可达米级。
- GNSS失锁0～10秒：INS/DR递推主导，轮速提供纵向速度约束，航向由陀螺仪维持，位置误差通常小于5米。
- GNSS失锁10～60秒：陀螺仪零偏导致航向缓慢漂移，轮速标度误差导致纵向累积，位置误差可能增至10～30米。
- GNSS恢复后：滤波重新收敛，位置误差迅速回落，同时更新零偏估计，为下一次失锁做准备。
常见误区：认为“有了GNSS就不需要IMU”或“有了IMU就不需要轮速”。实际上，GNSS更新频率低且易失锁，IMU高频但漂移，轮速在低速和打滑时也有误差。三者互补才能构成鲁棒的车载导航系统。另一个误区是忽略坐标系定义，直接把GNSS的LLA坐标与IMU的Body系速度相加，导致量纲和方向完全错误。
五、复盘要点与参数清单
在进入后续章节前，建议确认以下工程参数与定义已明确：
# 组合导航基础参数检查清单
IMU安装角: roll_offset, pitch_offset, yaw_offset [deg]
轮速脉冲当量: pulses_per_meter 或 meters_per_pulse [m]
GNSS天线杆臂: lever_arm_xyz (Body系) [m]
坐标系约定: ENU / ECEF / LLA / Body / Vehicle
时间同步: IMU与GNSS时间戳对齐误差 < 1ms
初始对准: 静态航向对准或双天线GNSS定向
滤波频率: IMU递推 100~1000Hz, GNSS更新 1~10Hz
只有把上述基础概念与坐标系定义固化到工程文档和代码接口中，后续的卡尔曼滤波设计、误差建模与实车调试才能顺利推进。轮速与IMU组合导航的本质，是在统一坐标系与统一时基下，让不同特性的传感器各展所长、互为补充。