第一章 导航基础概念：INS、GNSS与组合导航
各位同学好，我是老张。在导航这行摸爬滚打了十几年，今天咱们聊聊组合导航最底层的那些事儿。
很多人一上来就盯着卡尔曼滤波公式看，结果越看越懵。我建议你先别急，把INS和GNSS这两个"主角"搞清楚，后面的滤波自然就顺了。
1.1 惯性导航系统（INS）原理
INS这东西，说白了就是一个"猜位置"的系统。它不依赖任何外部信号，全靠自己身体里的加速度计和陀螺仪来推算。
核心器件有两个：
- 加速度计：测量三个轴的加速度。你想想看，知道加速度，积分一次得速度，再积分一次得位置。
- 陀螺仪：测量三个轴的角速度。积分得到姿态角（横滚、俯仰、航向）。
嗯，这里要注意：积分会累积误差。加速度计有零偏，陀螺仪有漂移，积分一次误差变大一次。我在项目中遇到过，一个中精度的MEMS IMU，纯惯性跑10分钟，位置误差能飘到几百米。
INS的致命弱点：误差随时间累积，无法单独长时间工作。
INS的数学表达（简化版）：
位置更新： p_k = p_{k-1} + v_{k-1}·dt + 0.5·a·dt²
速度更新： v_k = v_{k-1} + a·dt
姿态更新： 用四元数或方向余弦矩阵，这里不展开我刚开始做INS时，总觉得积分很简单。直到有一次调试，发现加速度计有个0.01m/s²的零偏没补偿，10分钟后位置误差已经大到离谱。从那以后，我对"积分"这两个字充满了敬畏。
1.2 全球导航卫星系统（GNSS）原理
GNSS就是咱们常说的GPS、北斗这些。它靠卫星发信号，地面接收机算位置。
基本原理：
- 卫星知道自己的位置（星历提供）
- 卫星发射带有时间戳的信号
- 接收机收到信号，算出信号传播时间
- 传播时间 × 光速 = 卫星到接收机的距离
- 至少4颗卫星，就能解出三维位置和时间
你想想看，这其实是个三角定位问题。但实际没那么简单——信号穿过大气层会延迟，卫星钟也有误差，多路径效应更是让人头疼。
个人经验：在城市峡谷或隧道里，GNSS信号会丢失或跳变。我曾经在立交桥下测试，定位点直接跳到对面车道，差点以为算法写错了。
GNSS的致命弱点：
- 更新频率低（通常1-10Hz）
- 容易受遮挡和多路径干扰
- 动态环境下容易失锁
1.3 组合导航的基本思想
好了，现在你看到了：INS能短时高精度，但长期会飘；GNSS长期稳定，但短时容易掉。组合导航，就是把这两个"瘸腿"的家伙绑在一起走路。
核心思想就一句话：用GNSS的绝对观测值，去修正INS的累积误差；用INS的高频输出，去填补GNSS的更新间隙。
我习惯把INS比作"盲人"，GNSS比作"拐杖"。盲人自己走会偏，拐杖时不时敲一下地面告诉他"你在哪"。但拐杖也不是万能的——遇到坑（信号遮挡）就敲不准了。
组合导航的三种模式：
- 松组合：GNSS先解算出位置速度，再和INS做融合。简单，但GNSS内部已经滤波过一次，信息有损失。
- 紧组合：直接用GNSS的原始观测值（伪距、载波相位）和INS融合。精度更高，但算法复杂。
- 深组合：GNSS接收机的跟踪环路和INS深度融合。这个一般做硬件的才碰，咱们做软件的了解前两种就够了。
1.4 组合导航的优势
说白了，1+1>2。具体好在哪？
| 对比项 | 纯INS | 纯GNSS | 组合导航 |
|---|---|---|---|
| 短期精度 | 高 | 中 | 高 |
| 长期稳定性 | 差（漂移） | 好 | 好 |
| 更新频率 | 高（100Hz+） | 低（1-10Hz） | 高 |
| 抗干扰能力 | 强（不受外界影响） | 弱 | 强 |
| 成本 | 高（高精度IMU） | 低 | 中等 |
我在做无人车项目时，纯GNSS在树荫下就飘，纯INS过个弯就偏。组合导航一上，定位误差从米级降到分米级。嗯，这就是组合的魅力。
避坑指南：我曾经以为组合导航就是"INS+GNSS+卡尔曼滤波"这么简单。结果第一次联调时，发现IMU和GNSS的时间戳对不上，数据频率也不匹配。后来花了整整一周做时间同步和插值。所以，时间同步是组合导航的第一个坑，千万别忽视。
1.5 知识体系总览
下面这张图，是我自己画的知识框架。你把它记在脑子里，后面学卡尔曼滤波时就不会迷路。
这张图我建议你保存下来。每次学新知识点时，都回来看看它在整个体系中的位置。我自己就是这么过来的——先搭框架，再填细节。
好了，第一章就到这里。INS和GNSS的原理是基础中的基础，后面所有滤波、调参都建立在这上面。如果你现在觉得"INS积分会飘"、"GNSS会丢信号"这些概念还不够清晰，建议回头再看一遍。
下一章，咱们正式进入卡尔曼滤波的世界。别怕，我会用最接地气的方式讲给你听。