朱晓章
开通时间 : ..
最后更新时间 : ..
最近遇到采用我们的双天线卫星惯导设备进行L4/L5自动驾驶开发的团队反馈,为什么每天早晨发车的时候,航向角会在几度范围内抖动,是否有办法消除,这其实是双天线RTK-INS的典型性能表现,并非算法bug或者系统故障,具体机理分析如下。最后,通过调查,我们确实也发现这辆车的RTK副天线存在射频电缆虚接问题,导致副天线不能很好的贡献航向角信息,后通过INS算法优化临时处理,后续车辆更换预埋的副天线线束可得到更好的冷启动性能。
https://docs.google.com/document/d/1nSoVht9E_pXFN0WnKdaX6xTZNU2Q0UZE9LP-1vTu9lw/edit?tab=t.0
双天线全球导航卫星系统/惯性导航系统 (GNSS/INS) 组合导航系统在现代运动载体的姿态与位置确定中至关重要。GNSS提供绝对位置,INS输出高频姿态。双天线技术能直接测量航向角,对INS初始对准和动态校准极具价值。
核心问题:设备“冷启动”后,在内部估计算法(如模糊度解算、卡尔曼滤波)完全收敛前,输出的航向角精度通常无法达到最终性能指标。本图表旨在剖析其背后原因。
通过精确测定载体上两个GNSS天线间的相对位置向量(基线向量),转换到当地水平坐标系后,利用其东向 ($\Delta e$) 和北向 ($\Delta n$) 分量计算航向角 $\psi = \arctan(\frac{\Delta e}{\Delta n})$。
[天线1] --- (基线向量) --- [天线2]
基线精度 → 航向精度
为实现厘米级基线解算,依赖高精度的GNSS载波相位观测值。实时动态差分 (RTK) 技术通过差分处理消除共模误差,是高精度相对定位的关键。
示意图:RTK提高定位精度
载波相位存在未知的整周模糊度,必须准确解算 (固定解) 才能发挥其高精度潜力。在固定之前为浮点解,精度较低。
IAR是获得可靠GNSS航向的前提。
陀螺仪: 测量角速度,积分后得到姿态角 (含航向角)。
加速度计: 测量线加速度,积分得到速度和位置;静态时感知重力确定水平姿态。
INS通过“航位推算”提供连续导航信息,但误差会累积。
INS需确定初始姿态、速度、位置才能准确工作。常见方法:
陀螺仪误差是关键,尤其是在初始对准阶段未能准确估计和补偿时:
初始陀螺零偏未知或较大,会导致航向从一开始就快速偏离真值。
1. 首次定位时间 (TTFF) 显著延长:
2. 载波相位模糊度初始“浮点解”状态:
在IAR固定为整数解前,只能提供低精度浮点解航向,误差可达数度甚至数十度。
示意图:冷启动TTFF与模糊度解算阶段
1. 惯性传感器的预热与初始误差特性:
2. 初始对准的困境:
INS初始航向非常不确定,对准耗时。
通过LAMBDA等算法处理多历元数据,从实数估计中找出最或然整数解。获得可靠固定解需数秒到数分钟。
影响因素:
卡尔曼滤波器融合GNSS与INS信息,估计INS导航误差(位置、速度、姿态误差)和传感器误差(陀螺零偏等)。
关键状态收敛 (航向、陀螺零偏):
在冷启动初期,GNSS的IAR和卡尔曼滤波器的状态估计相互依赖。只有当IAR提供稳定固定解后,卡尔曼滤波器才能快速驱动INS误差状态收敛,实现高精度航向。
示意图:航向误差与陀螺零偏估计随时间收敛过程
下表对比了系统在不同工作阶段的状态与航向性能:
阶段 | GNSS模糊度状态 | GNSS航向质量 | INS对准状态 | 陀螺零偏估计 | 组合系统航向精度 |
---|---|---|---|---|---|
冷启动瞬时 | 无 | 不可用 | 未对准/漂移中 | 初始高不确定 | 极低/不可用 |
GNSS首次定位/浮点解 | 浮点 | 低/不稳定 | 依赖GNSS辅助/缓慢对准中 | 持续高不确定/缓慢估计中 | 低/较大误差 |
GNSS模糊度固定解/滤波器收敛中 | 固定 | 高/较稳定 | 快速对准/接近收敛 | 逐渐收敛/不确定性减小 | 显著改善/接近标称值 |
算法完全收敛 | 固定 | 高/稳定 | 精确对准 | 已收敛/低不确定性 | 达到标称指标 |
核心原因:
双天线GNSS/INS设备冷启动初期航向精度不佳,主要源于:GNSS初始信息质量不足、INS初始状态不确定且漂移、组合导航算法(卡尔曼滤波器)收敛耗时,以及初期GNSS与INS子系统间的弱支撑效应。
冷启动后航向精度逐步提升的过渡阶段,是系统从无先验信息到精确感知的必然过程。用户应理解此特性,避免在算法未充分收敛前对精度有过高期望。
未来技术发展可能从以下方面改进初期性能: