第二章 惯性导航系统(INS)基础
各位同学好，我是老张。今天咱们聊聊惯性导航系统，也就是INS。说实话，这玩意儿是组合导航的"脊梁骨"，你搞不懂它，后面那些卡尔曼滤波、松紧耦合什么的，基本就是空中楼阁。
我记得刚入行那会儿，带我的老师傅说过一句话："惯性导航，说白了就是'猜'你在哪。"当时我不理解，后来做了十几年项目，才明白这话有多精辟。
2.1 INS工作原理：从牛顿定律说起
INS的原理其实不复杂。你想想看，牛顿第一定律告诉我们——物体不受外力时，保持静止或匀速直线运动。那如果我们能测量出物体受到的加速度，再对时间积分，是不是就能算出速度和位置？
嗯，就是这么个逻辑。
核心公式（简化版）：
速度 = 初始速度 + ∫(加速度) dt
位置 = 初始位置 + ∫(速度) dt说白了，就是两次积分。
但这里有个坑——你测出来的加速度是相对于惯性空间的，而我们要的是相对于地球的。所以必须做坐标变换，把加速度从"载体坐标系"转到"导航坐标系"。这个转换，靠的就是陀螺仪测出来的姿态角。
我在项目中遇到过一件事：有个同事把坐标系搞反了，结果导航解算出来的位置直接飞到了太平洋中间。嗯，那次测试我们笑了好几天，但笑完之后是冷汗——要是真飞起来，后果不堪设想。
2.2 加速度计与陀螺仪：INS的两大核心
INS的硬件核心就两个东西：加速度计和陀螺仪。一个测线运动，一个测角运动。
2.4.1 加速度计
加速度计测量的是比力，也就是物体受到的惯性力减去重力。你把它放在桌面上，它测出来的是1g（重力加速度），而不是0。这个细节很多人会忽略。
常见的加速度计类型：
- 石英加速度计：精度高，但贵。航天级产品用的多。
- MEMS加速度计：便宜、体积小，但噪声大。手机里用的就是这种。
- 摆式加速度计：老式产品，现在基本被淘汰了。
我的经验：选加速度计的时候，别光看精度指标。你得看它的零偏稳定性。我曾经在一个无人机项目里用了某款MEMS加速度计，标称精度不错，但零偏随温度漂移得厉害，飞了十分钟位置就偏出去几百米。后来换了石英的，问题才解决。
2.4.2 陀螺仪
陀螺仪测量角速度。没有它，你就不知道载体朝哪个方向转，加速度计的数据也就没法正确投影到导航坐标系。
陀螺仪的分类：
| 类型 | 精度等级 | 典型应用 | 价格 |
|---|---|---|---|
| 激光陀螺 | 0.001°/h | 战略导弹、潜艇 | 几十万 |
| 光纤陀螺 | 0.01°/h | 战术导弹、飞机 | 几万 |
| MEMS陀螺 | 1°/h | 消费电子、汽车 | 几十块 |
你看这个表，精度和价格是成正比的。做项目的时候，别总想着用最好的，够用就行。我见过有人给玩具无人机配光纤陀螺，那纯粹是浪费钱。
2.3 惯性导航的误差源：为什么INS会"飘"
INS最大的毛病就是误差会随时间累积。你想想看，两次积分，任何微小的误差都会被放大。
主要的误差来源有这几个：
- 零偏误差：传感器在零输入时也有输出。这个误差积分一次变成速度误差，再积分一次变成位置误差。
- 刻度因子误差：输入和输出之间的比例关系不准。比如你输入1g，它输出1.001g，那0.1%的误差就会一直存在。
- 安装误差：传感器装歪了。这个误差会导致加速度和角速度的测量值互相耦合。
- 噪声：随机噪声，没法完全消除，只能靠滤波。
避坑指南：我曾经在一个车载导航项目里，忽略了温度对零偏的影响。结果夏天测试没问题，冬天一开机，位置直接漂了500米。后来我养成了一个习惯——所有传感器必须先做温度补偿，再谈精度。
为什么会这样？因为加速度计的零偏误差对位置的影响是时间平方级的。举个例子：
假设零偏误差 = 0.01 m/s²
积分10秒后，速度误差 = 0.1 m/s
积分100秒后，速度误差 = 1 m/s，位置误差 = 50 m
积分1000秒后，速度误差 = 10 m/s，位置误差 = 5000 m你看，1000秒也就16分钟，位置误差已经5公里了。这就是为什么INS不能单独长时间工作，必须配合其他传感器。
2.4 INS的优缺点：没有完美的导航系统
做导航系统这么多年，我最大的体会就是——没有完美的方案，只有合适的方案。
INS的优点：
- 完全自主：不依赖外部信号，不会被人干扰或欺骗。军事上特别看重这一点。
- 输出频率高：一般能到100Hz以上，适合做控制。
- 短期精度高：几秒到几十秒内，INS的精度比GPS还高。
- 能测姿态：GPS只能给位置和速度，姿态还得靠INS。
INS的缺点：
- 误差随时间累积：刚才已经说过了，这是硬伤。
- 初始对准麻烦：启动时需要知道初始位置和姿态，不然没法算。
- 成本高：高精度的INS比GPS接收机贵得多。
- 体积和重量：高精度INS又大又重，小飞机装不下。
我的总结：INS就像一个有天赋但性格有缺陷的运动员——短期爆发力强，但耐力不行。组合导航要做的，就是用GPS、视觉、里程计这些"外援"来弥补它的短板。
2.5 本章知识体系
下面这张图是我自己画的，把INS的核心逻辑串起来了。你仔细看看，应该能对本章内容有个整体把握。
这张图把INS的"原理→传感器→误差→优缺点→结论"串起来了。你把它记在脑子里，后面学组合导航的时候，会轻松很多。
好了，这一章就到这里。INS是组合导航的根基，理解透了，后面那些滤波算法、融合策略才能学得明白。下一章我们讲GPS基础，到时候再聊。