1. 导航系统概述:从GNSS到组合导航
做导航调参这些年,我最大的感受是:很多人把调参当成玄学。参数调对了不知道为什么对,调错了也不知道错在哪。说白了,就是缺乏对导航系统底层原理的理解。
这一章,我们先打好地基。把GNSS、INS、组合导航的基本原理讲清楚,再聊聊那些你面试时一定会被问到的性能指标。嗯,这些都是我实际项目中踩过的坑,希望能帮你少走弯路。
1.1 GNSS:全球导航卫星系统
GNSS,全称Global Navigation Satellite System。你手机里的GPS、北斗,都属于这个范畴。
它的工作原理其实不复杂:卫星不停地广播自己的位置和时间,接收机收到信号后,通过计算信号传播的时间差,就能算出自己离卫星有多远。同时收到4颗以上卫星的信号,就能解算出三维位置和钟差。
核心公式(伪距观测方程):
ρ = r + c·δt_u + c·δt_s + I + T + ε
其中:ρ是伪距测量值,r是真实几何距离,c是光速,δt_u是接收机钟差,δt_s是卫星钟差,I是电离层延迟,T是对流层延迟,ε是测量噪声。
这里有个坑,我刚开始做的时候吃过亏:伪距不是真实距离,它包含了各种误差。你想想看,信号从两万公里外的卫星传下来,穿过电离层、对流层,再被接收机处理,中间有多少误差源?
GNSS的定位精度,单点定位一般在米级。用差分技术(DGNSS、RTK)可以到厘米级。但有个致命弱点——信号容易被遮挡。隧道里、高楼林立的城市峡谷、甚至茂密的树林,都可能让定位失效。
1.2 INS:惯性导航系统
INS就不一样了。它完全自主,不依赖任何外部信号。
原理也很直观:用加速度计测量比力,用陀螺仪测量角速度。然后对加速度积分得到速度,再积分得到位置。陀螺仪则用来确定姿态,把加速度从载体坐标系转换到导航坐标系。
我个人习惯把INS比作盲人走路:
你知道自己迈了多大步子(加速度),也知道自己朝哪个方向转(角速度),但走久了就会偏离真实路径。因为每一步的误差都会累积——这就是INS的误差漂移问题。
INS的更新频率很高,通常100Hz以上。短时精度好,但长时精度差。我见过一个项目,只用INS导航,10分钟后位置误差就漂到了几百米。
1.3 组合导航:取长补短
既然GNSS和INS各有优缺点,那把它们组合起来不就完美了?
这就是组合导航的核心思想:用GNSS的长期稳定性来校正INS的漂移,用INS的高更新率来填补GNSS的缺失。
最常见的组合方式是松组合和紧组合:
| 组合方式 | 输入 | 优点 | 缺点 |
|---|---|---|---|
| 松组合 | GNSS位置/速度 + INS位置/速度 | 实现简单,计算量小 | GNSS输出中断时无法工作 |
| 紧组合 | GNSS伪距/伪距率 + INS预测值 | 可用卫星少于4颗时仍能工作 | 实现复杂,需要原始观测值 |
| 深组合 | GNSS中频信号 + INS辅助跟踪 | 抗干扰能力最强 | 硬件改动大,成本高 |
我实际项目中用得最多的是紧组合。为什么?因为城市里经常只有3颗甚至2颗卫星可见,松组合直接就罢工了,紧组合还能撑一撑。
下面这张图,是我自己总结的组合导航核心流程:
1.4 导航系统性能指标
做导航系统,光知道原理不够。你得知道怎么评价一个导航系统好不好。这里有四个核心指标,我面试时经常问候选人:
- 精度(Accuracy):测量值与真实值的偏差。通常用圆概率误差(CEP)或均方根误差(RMS)表示。比如定位精度1米(RMS),意味着68%的定位误差在1米以内。
- 可用性(Availability):系统能够提供满足精度要求服务的时间百分比。我见过一个项目,号称可用性99.9%,结果在隧道里直接归零——这就是没考虑场景。
- 连续性(Continuity):在已提供服务的情况下,系统能持续提供服务的能力。说白了就是别突然掉链子。
- 完好性(Integrity):系统在超出允许误差时,能否及时向用户发出告警。这个指标在航空领域极其重要,因为导航出错可能意味着机毁人亡。
我曾经踩过的坑:
有一次做车载导航测试,精度指标看起来很好,CEP只有0.5米。但实际跑起来,车辆在高架桥下频繁出现定位跳变。后来一查,是完好性监测没做好——系统没有及时检测到多路径效应导致的异常。所以,精度好不代表系统可靠,完好性才是安全底线。
1.5 导航调参的工程意义
好,现在你知道了导航系统的基本原理和评价指标。那调参到底调的是什么?
说白了,调参就是调整卡尔曼滤波器里的那些噪声协方差矩阵。比如:
- 过程噪声协方差Q:描述INS误差随时间演化的不确定性。Q设大了,滤波器更相信观测值(GNSS);Q设小了,滤波器更相信预测值(INS)。
- 观测噪声协方差R:描述GNSS测量值的不确定性。R设大了,滤波器对GNSS的信任度降低。
这两个矩阵的比值,直接决定了滤波器的行为。我见过一个团队,调了三个月参数,最后发现是Q矩阵里一个元素写错了数量级。
我的调参经验:
刚开始调参时,别一上来就动所有参数。先固定R(根据GNSS接收机的标称精度来设),然后调Q。Q的物理意义要清楚——比如加速度计零偏不稳定性对应的噪声谱密度,可以从IMU数据手册里查到。这样调出来的参数才有物理依据,而不是瞎蒙。
调参的工程意义,在于让导航系统在真实场景下达到最优性能。实验室里跑得再好,到了实际环境——城市峡谷、高架桥下、隧道出口——才是真功夫。
嗯,这一章的内容就到这里。记住:理解原理是调参的前提,指标是评价的标尺,而调参本身,是让理论落地到工程的那座桥。