4. 坐标系与时间系统
在GNSS/IMU紧耦合导航中,坐标系与时间系统是贯穿始终的“公共语言”。IMU输出的角速度和比力都在机体坐标系下,GNSS观测(伪距、载波相位、卫星位置)通常在ECEF下描述,而组合导航滤波的状态量、误差量又常定义在NED或ECEF中。如果坐标系定义、姿态表示方式或时间基准不统一,即使滤波算法本身正确,融合结果也会出现系统性偏差。本节围绕五个核心问题展开:ECEF与ECI的区别与联系、NED与机体坐标系的定义、姿态的多种表示及其转换、GNSS时与UTC的换算,以及这些约定在紧耦合中的实际使用方式。
一、ECEF与ECI:地固系与惯性系
ECI(Earth-Centered Inertial)是惯性坐标系,原点在地心,坐标轴指向恒星,不随地球自转。ECEF(Earth-Centered Earth-Fixed)是地固坐标系,原点同样在地心,但坐标轴固定在地球上,随地球一起旋转。两者之间的差异就是地球自转角。设地球自转角速度为ωe≈7.292115×10-5 rad/s,从ECI到ECEF的旋转矩阵为绕Z轴旋转角度θG(格林尼治恒星时角):
R_eci2ecef = [ cosθG sinθG 0
-sinθG cosθG 0
0 0 1 ]
在紧耦合中,IMU的陀螺测量的是惯性角速度,而GNSS卫星位置通常由星历在ECEF下计算。因此,机械编排中需要明确:姿态更新是在惯性系还是地固系下进行。若采用ECEF机械编排,则需从陀螺测量中扣除地球自转分量ωie;若采用ECI机械编排,则保留惯性角速度,最后再转换到ECEF与GNSS观测对齐。两种方式等价,但必须全程一致。
二、NED与机体坐标系
NED(North-East-Down)是局部导航坐标系,原点位于载体所在位置,N轴指向地理北,E轴指向东,D轴指向地心。NED与ECEF之间的转换由载体纬度φ和经度λ决定。在NED下,重力矢量近似为[0, 0, g]T,这使速度、位置误差方程形式简洁,因此组合导航滤波常选NED作为导航系。
机体坐标系(b系)固连于载体,通常定义:Xb指向机头(前),Yb指向右翼,Zb指向机腹(下),构成右手系。IMU的三个陀螺和三个加速度计分别沿b系三轴安装。姿态角即b系相对于n系的旋转关系:俯仰角θ绕Yb,横滚角γ绕Xb,航向角ψ绕Zb。需要注意,不同教材对机体轴指向(前右下或前右上)定义不同,紧耦合实现中必须与IMU安装矩阵、GNSS天线杆臂一致。
三、姿态表示:欧拉角、方向余弦矩阵与四元数
姿态描述的是b系相对于n系的旋转关系。常用三种表示:欧拉角直观但存在万向节死锁;方向余弦矩阵Cbn无奇异但需正交化;四元数计算效率高、无奇异,是紧耦合姿态更新的首选。从n系到b系的旋转顺序通常取Z-Y-X(航向-俯仰-横滚),对应矩阵为:
C_n^b = Rz(ψ) * Ry(θ) * Rx(γ)
四元数更新公式为:
q(k+1) = q(k) + 0.5 * Ω(ω_nb^b) * q(k) * Δt
其中ωnbb是b系相对于n系的角速度,需从陀螺测量ωibb中扣除地球自转和载体运动引起的n系旋转:ωnbb = ωibb − Cnb(ωien + ωenn)。这一步是紧耦合机械编排的关键,漏掉任何一项都会在航向或位置中引入缓慢漂移。
四、GNSS时与UTC转换
GNSS系统使用自己的时间基准。以GPS为例,GPS时(GPST)起点为1980年1月6日UTC 00:00:00,不含闰秒。UTC则通过闰秒与地球自转保持同步。当前GPS时与UTC的差值为18秒(截至2024年),即:
UTC = GPST - 18s
GPST = UTC + 18s
在紧耦合中,IMU采样时刻通常由本地时钟记录,而GNSS观测时刻由接收机给出GPST。若两者未统一到同一时标,伪距率与IMU预测之间会产生时间不同步误差。实际处理时,需将IMU时间戳转换为GPST,或把GNSS观测时刻插值到IMU时间轴上。此外,GPS周数(WN)和秒数(TOW)需正确解析,注意周翻转问题(每1024周翻转一次,下一次在2038年)。
五、紧耦合中的坐标系与时间使用要点
综合来看,紧耦合实现中需要固定以下约定:
- 导航系:选择NED或ECEF,全程一致。NED适合局部导航,ECEF适合全球场景。
- 姿态表示:内部用四元数更新,输入输出可转欧拉角或DCM。
- IMU安装:明确b系轴向定义,标定安装矩阵,确保与GNSS天线杆臂一致。
- 时间基准:统一到GPST,处理闰秒和GPS周翻转。
- 地球自转:ECEF机械编排中扣除ωie,ECI中保留。
例如,某无人机紧耦合系统采用NED导航系、四元数姿态、GPST时标。IMU以200Hz采样,GNSS以10Hz输出伪距和载波相位。每个IMU采样时刻tk,先由陀螺更新四元数,再由加速度计更新速度和位置;当GNSS观测到达时,将观测时刻tG与最近的IMU时刻对齐,计算伪距残差和相位残差,送入EKF更新。若发现航向缓慢漂移,应优先检查ωie和ωen是否被正确扣除,以及GNSS天线杆臂是否在b系下正确补偿。
坐标系与时间系统是紧耦合的“地基”。只有把ECEF/ECI、NED/机体、姿态表示、GNSS时/UTC这四组关系理清并在代码中严格统一,后续的滤波、残差构造和故障检测才有意义。