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颗卫星可见,松组合直接就罢工了,紧组合还能撑一撑。

下面这张图,是我自己总结的组合导航核心流程:

组合导航核心流程 组合导航核心流程 GNSS接收机 位置/速度/伪距 IMU(加速度计+陀螺) 比力/角速度 INS机械编排 姿态/速度/位置更新 卡尔曼滤波器 状态估计:位置误差/速度误差/姿态误差/零偏 反馈校正 → INS输出 观测值 预测值 误差校正 组合导航输出(位置/速度/姿态) 核心:误差状态卡尔曼滤波

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数据手册里查到。这样调出来的参数才有物理依据,而不是瞎蒙。

调参的工程意义,在于让导航系统在真实场景下达到最优性能。实验室里跑得再好,到了实际环境——城市峡谷、高架桥下、隧道出口——才是真功夫。

嗯,这一章的内容就到这里。记住:理解原理是调参的前提,指标是评价的标尺,而调参本身,是让理论落地到工程的那座桥。