第一章 惯性导航基础：从原理到实战
各位同学，欢迎来到《惯性导航与飞控系统集成实战》的第一课。
我是你们的讲师，一个在飞控和惯导领域摸爬滚打了十几年的老工程师。今天咱们聊点硬核的——惯性导航基础。别被“基础”两个字骗了，这玩意儿是后面所有实战的根基。地基打不牢，楼盖得再高也得塌。
1.1 惯性导航原理概述：它到底在干嘛？
惯性导航，说白了就是“猜”你在哪。
怎么猜？靠两个东西：加速度计和陀螺仪。加速度计告诉你“我往哪个方向加速了”，陀螺仪告诉你“我脑袋朝哪个方向转了”。然后，你从起点开始，把这些信息累加起来，就能算出你当前的位置和姿态。
嗯，这里要注意：它不需要任何外部信号，GPS、WiFi、蓝牙，统统不需要。这就是它最牛的地方——完全自主。
核心思想： 已知初始位置 + 测量加速度 + 测量角速度 → 积分 → 当前位置和姿态。
我在做无人机项目时，有一次GPS信号被强干扰，飞机差点失控。幸亏惯导系统还在工作，硬是靠着纯惯性推算飞了回来。那次之后，我对惯导的敬畏心就上来了。
1.2 坐标系定义：你得知道你在哪个“世界”里说话
搞惯导，坐标系是绕不开的坎。你想想看，你说“向东飞了10米”，这个“东”是相对于哪个地球？是相对于地心？还是相对于你起飞时的朝向？
所以，我们必须把坐标系定义清楚。常用的有三个：
- 地心地固系（ECEF）： 原点在地心，Z轴指向北极，X轴指向本初子午线与赤道的交点。说白了，就是地球这个“大石头”本身的坐标系。
- 导航系（NED）： 原点在你当前的位置，X轴指向北，Y轴指向东，Z轴指向地心（向下）。这是飞控里最常用的坐标系，因为“北东地”最符合人的直觉。
- 载体系（Body Frame）： 原点在飞行器的重心，X轴指向机头，Y轴指向右翼，Z轴指向机腹。这个坐标系是跟着飞机一起动的。
我个人习惯，在飞控代码里，所有传感器数据先统一转到载体系，然后通过姿态矩阵转到导航系，最后再算位置。这样逻辑最清晰，不容易出错。
避坑指南： 我曾经在项目里搞混了导航系和载体系的顺序，结果算出来的姿态角全是反的。飞机一推杆，它抬头；一拉杆，它低头。嗯，那次试飞差点把飞机摔了。所以，坐标系转换一定要写单元测试！
1.3 姿态表示方法：怎么描述飞机“歪”了多少？
飞机在空中，不可能永远平飞。它会有俯仰、滚转、偏航。怎么描述这些“歪”的程度？有三种主流方法。
1.3.1 欧拉角
最直观的方法。三个角度：滚转角（φ）、俯仰角（θ）、偏航角（ψ）。你一看就知道飞机是头朝上还是朝下。
但是，欧拉角有个致命问题——万向锁。当俯仰角接近±90°时，滚转和偏航会耦合在一起，你分不清哪个是哪个。我在做垂直起降固定翼时，就遇到过这个问题。飞机在悬停转平飞的过程中，俯仰角刚好经过90°，姿态解算直接炸了。
1.3.2 四元数
四元数是个数学工具，用四个数（q0, q1, q2, q3）来表示旋转。它没有万向锁问题，计算效率也高。飞控里99%的姿态解算都用它。
你可能会问：“四个数怎么表示旋转？” 嗯，你可以把它想象成一个“旋转轴 + 旋转角度”的打包形式。具体数学推导，咱们后面章节再细讲。
1.3.3 方向余弦矩阵（DCM）
DCM是一个3x3的矩阵，每一列代表一个轴在另一个坐标系中的投影。它很直观，但计算量大。早期飞控用得多，现在基本被四元数取代了。
| 方法 | 优点 | 缺点 | 实战建议 |
|---|---|---|---|
| 欧拉角 | 直观，容易理解 | 万向锁，计算慢 | 仅用于人机交互显示 |
| 四元数 | 无奇点，计算快 | 不直观 | 飞控内部核心计算 |
| DCM | 物理意义清晰 | 计算量大 | 教学或低动态场景 |
我的建议： 代码里用四元数做所有计算，只在最后输出给地面站时，才转成欧拉角。这样既避免了万向锁，又方便人看。
1.4 惯性传感器：加速度计与陀螺仪
传感器是惯导系统的“眼睛”和“耳朵”。它们不完美，但我们必须学会跟它们相处。
1.4.1 加速度计
加速度计测量的是“比力”，也就是物体受到的合力（重力 + 外力）除以质量。你把它放在桌上，它测到的是1g（重力加速度）。你把它自由落体，它测到的是0g。
我在项目中遇到过一个问题：飞机在剧烈震动时，加速度计输出全是噪声。后来发现是安装基座没有做减震处理。嗯，机械设计有时候比算法更重要。
1.4.2 陀螺仪
陀螺仪测量的是角速度，也就是你转得有多快。它不直接告诉你角度，你需要对时间积分才能得到角度。
但是，积分会累积误差。陀螺仪有零偏，哪怕静止时它也会输出一个很小的非零值。这个值积分久了，角度就会漂移。我曾经用一款低端MEMS陀螺仪做实验，静止10分钟，角度漂了30度。你说这能忍吗？
1.4.3 误差模型
传感器误差主要分三类：
- 零偏（Bias）： 静止时输出的非零值。可以标定补偿。
- 尺度因子（Scale Factor）： 输入和输出之间的比例偏差。比如你转90°，它告诉你转了91°。
- 随机游走（Random Walk）： 噪声的积分效应。这是最难处理的，通常用滤波器来抑制。
警告： 不要相信任何传感器的原始数据！一定要做标定和滤波。我曾经见过一个团队，直接把加速度计原始数据拿来算倾角，结果飞机在地面上就显示倾斜了5度。嗯，那架飞机永远飞不起来。
知识体系总览
下面这张图，是我自己画的本章知识结构。你可以把它当作一个“地图”，后面每学一个知识点，就回来看看它在整个体系中的位置。
好了，第一章的内容就到这里。记住，惯性导航的核心就是“积分”。后面我们会一步步深入，从传感器标定到姿态解算，再到位置融合。每一步都离不开今天讲的这些基础。
课后思考： 如果加速度计和陀螺仪都有误差，纯惯性导航能维持多久的精度？试试看，在脑子里推演一下。
公众号:蓝海资料掘金营，微信deep3321