2. 定位导航基础

在IMU与GNSS融合定位工程中,理解三大定位方式的基本原理、术语体系和坐标系定义,是后续算法设计、数据处理与系统调试的基础。惯性导航(INS)依靠加速度计和陀螺仪推算位置姿态,卫星导航(GNSS)通过测距交会获得绝对位置,组合导航则将两者优势互补,形成连续、稳定、高精度的定位结果。本节从原理出发,梳理关键术语与坐标系,为后续章节建立统一的概念框架。

一、惯性导航基本原理

惯性导航系统(Inertial Navigation System, INS)的核心是牛顿力学:加速度计测量比力,陀螺仪测量角速度。通过对角速度积分得到姿态,将比力投影到导航坐标系并扣除重力后积分得到速度,再积分得到位置。这一过程称为“航位推算”(Dead Reckoning)。

惯性导航的优点是自主性强、输出频率高、短时精度好;缺点是误差随时间累积,长时间运行会产生漂移。根据是否使用物理平台稳定,INS可分为平台式惯导和捷联式惯导(SINS)。现代工程中,捷联式惯导因结构简单、成本低、可靠性高而成为主流。

核心公式链:角速度 → 姿态 → 比力投影 → 速度 → 位置。每一步积分都会引入误差,因此需要外部观测(如GNSS)进行校正。

二、卫星导航基本原理

全球导航卫星系统(GNSS)包括GPS、北斗、GLONASS、Galileo等。其基本原理是:卫星发射带有时间戳和星历的导航信号,接收机测量信号传播时间,乘以光速得到伪距。通过至少四颗卫星的伪距观测,解算接收机的位置(x, y, z)和钟差。若使用载波相位观测,则可实现厘米级甚至毫米级定位。

GNSS的优点是绝对定位、长期稳定、无累积误差;缺点是信号易受遮挡、多径和干扰影响,在室内、隧道、城市峡谷等场景下可用性下降。常见增强方式包括差分GNSS(DGNSS)、实时动态(RTK)和精密单点定位(PPP)。

三、组合导航基本原理

组合导航(Integrated Navigation)将INS与GNSS结合,利用互补特性提升整体性能。INS提供高频、连续的姿态和位置推算,GNSS提供低频、绝对的位置和速度观测。通过卡尔曼滤波(KF)或扩展卡尔曼滤波(EKF)进行信息融合,估计并补偿INS的漂移误差。

组合方式主要分为松耦合、紧耦合和深耦合。松耦合中,GNSS和INS独立解算,再融合位置速度;紧耦合中,使用伪距、伪距率等原始观测与INS预测值共同滤波;深耦合则进一步在信号跟踪层面进行辅助。工程中,紧耦合在遮挡场景下表现更优,但实现复杂度更高。

四、常见术语与坐标系定义

在融合定位中,术语和坐标系的统一至关重要。以下表格列出常见术语及其含义:

术语含义
IMU惯性测量单元,包含加速度计和陀螺仪
INS惯性导航系统,由IMU和导航解算组成
GNSS全球导航卫星系统,提供绝对位置
ECEF地心地固坐标系,原点在地球质心
ENU东-北-天当地水平坐标系
NED北-东-地当地水平坐标系
Body载体坐标系,随载体运动
伪距卫星到接收机的距离测量值,含钟差
载波相位卫星信号载波的相位观测值,用于高精度定位
卡尔曼滤波最优估计方法,用于多源信息融合

坐标系方面,ECEF用于卫星轨道和全球定位;ENU/NED用于局部导航和姿态描述;Body用于IMU测量值的表达。坐标转换通常涉及旋转矩阵、四元数或欧拉角。工程中需注意坐标系定义的一致性,避免因轴向或旋转顺序不同导致解算错误。

INS / GNSS / 组合导航 原理与坐标系关系 惯性导航 INS 加速度计 + 陀螺仪 角速度积分 → 姿态 比力投影 → 速度 → 位置 特点:高频、自主、误差累积 坐标系:Body → NED/ENU 卫星导航 GNSS 伪距 / 载波相位观测 至少4颗卫星 → 位置+钟差 RTK / PPP 增强 特点:绝对、低频、易遮挡 坐标系:ECEF → ENU/NED 组合导航 Fusion 卡尔曼滤波 / EKF 松耦合 / 紧耦合 / 深耦合 INS预测 + GNSS校正 输出:连续、稳定、高精度定位 误差校正 坐标系转换链:Body → NED/ENU → ECEF → 经纬高 Body NED/ENU ECEF 经纬高

五、案例与场景

以自动驾驶为例:车辆在城市道路行驶时,GNSS提供绝对位置,但在隧道或高楼遮挡下信号丢失;此时INS依靠陀螺仪和加速度计继续推算位置和姿态,维持短时精度。当GNSS恢复后,卡尔曼滤波利用新的观测校正INS漂移,实现无缝切换。若采用紧耦合,即使只有两颗卫星,也能利用伪距信息辅助INS,提升可用性。

工程提示:在组合导航中,时间同步至关重要。IMU和GNSS的观测时间戳必须对齐,否则滤波会引入额外误差。通常使用PPS信号或硬件触发实现微秒级同步。

六、常见误区与复盘

  • 误区一:认为INS可以长期独立工作。实际上,低成本MEMS IMU在数十秒内就会产生米级漂移,必须依赖GNSS校正。
  • 误区二:忽略坐标系定义。不同坐标系之间的旋转顺序(如ZYX与XYZ)会导致姿态解算错误,工程中需严格统一。
  • 误区三:盲目追求紧耦合。紧耦合实现复杂,若GNSS观测质量差,反而可能污染INS解算。应根据场景选择合适耦合方式。
  • 误区四:忽视杆臂补偿。IMU与GNSS天线不在同一位置,车辆转弯时会产生杆臂效应,需在滤波中进行补偿。