1. 惯性导航基础：惯性导航基本原理、坐标系定义与转换、地球模型与重力场
各位同学，欢迎来到惯性导航的世界。说实话，我做了十几年惯导系统，每次跟新人聊起基础，都觉得这玩意儿既简单又深奥。简单是因为原理就那几个字——牛顿定律；深奥是因为，嗯，你一旦开始算误差，就会发现处处是坑。
今天咱们先打好地基。地基不稳，后面谈误差抑制就是空中楼阁。
1.1 惯性导航基本原理
惯导的原理，说白了就是「用加速度计测加速度，用陀螺仪测角速度，然后积分两次得到位置」。你想想看，这跟咱们小时候走路数步子是不是一个道理？你迈一步，知道步长，数着步数，就知道走了多远。惯导就是把这个过程自动化、精密化了。
但这里有个关键问题：加速度计测的是「比力」，不是真正的运动加速度。比力 = 运动加速度 - 重力加速度。我当年刚入行时，就因为这个概念没吃透，在项目里算出来的位置飘了十万八千里。后来才明白，必须先把重力加速度从测量值里剔除，才能积分。
核心公式（导航坐标系下的惯导基本方程）：
V_dot = f - (2ω_ie + ω_en) × V + g其中：
V_dot —— 载体速度变化率（真正的加速度）
f —— 加速度计测量的比力
(2ω_ie + ω_en) × V —— 哥氏加速度和向心加速度（地球自转和载体运动引起）
g —— 重力加速度
我个人习惯把这个方程贴在工位上。每次调试遇到发散问题，先回来检查这个方程有没有用对。你想想看，如果哥氏项算错了，在高速运动场景下，误差会以分钟级别累积到不可接受。
1.2 坐标系定义与转换
坐标系是惯导的「语言」。不同坐标系下，同一个物理量的表达完全不同。我见过太多工程师因为坐标系搞混，导致整个算法推倒重来。
常用的坐标系有这几个：
- 地心惯性坐标系（i系） —— 牛顿定律成立的坐标系，原点在地心，轴指向恒星。说白了，这是「上帝视角」。
- 地球坐标系（e系） —— 固连在地球上，随地球自转。原点在地心，x轴指向本初子午线。
- 导航坐标系（n系） —— 通常用「东北天」或「北东地」。我们日常说的经纬高，就是在这个系里表达的。
- 载体坐标系（b系） —— 固连在载体上，x轴指向载体前进方向，y轴向右，z轴向下（或向上，看定义）。
坐标系转换的核心是方向余弦矩阵（DCM）和四元数。我个人更偏爱四元数，因为它没有欧拉角的万向锁问题。我在做无人机项目时，有一次飞机做大机动，欧拉角直接炸了，换成四元数后稳如老狗。
避坑指南： 我曾经在坐标系转换时，把「从b系到n系」和「从n系到b系」的矩阵搞反了。结果导航结果直接反着跑。后来我养成了一个习惯：每次写完转换代码，先用单位矩阵验证一下，再用手算一个简单旋转核对。
下面这张图是我自己总结的坐标系转换关系，你一看就明白：
1.3 地球模型与重力场
地球不是完美的球体，它是个椭球。这个事实对惯导的影响有多大？我举个例子：如果你用球体模型代替WGS-84椭球模型，在赤道附近，重力方向偏差能达到0.2度。对于高精度惯导，这个偏差足以让水平通道在几分钟内发散。
常用的地球模型有：
| 模型名称 | 特点 | 适用场景 |
|---|---|---|
| 球体模型 | 半径取平均值6371km，计算简单 | 低精度、短时间导航 |
| WGS-84椭球模型 | 长半轴6378137m，扁率1/298.257 | 高精度惯导、GPS组合导航 |
| 大地水准面模型 | 考虑重力异常，最精确 | 重力匹配导航、大地测量 |
重力场这块，我建议你记住一个关键点：重力是位置和纬度的函数。常用的正常重力公式是：
g(φ) = 9.780327 * (1 + 0.0053024 * sin²φ - 0.0000058 * sin²2φ) [m/s²]其中φ是纬度。你看，在赤道（φ=0）和两极（φ=90°），重力差了大约0.05 m/s²。这个差异如果不补偿，在垂直通道上，误差会以指数形式增长。嗯，这里要注意，垂直通道本身是不稳定的，必须引入外部高度信息（比如气压高度计）来抑制。
⚠️ 重要警告： 千万不要忽略地球自转的影响！地球自转角速度ω_ie ≈ 7.292115 × 10⁻⁵ rad/s。虽然数值很小，但积分后产生的误差在10分钟量级就能达到百米级别。我见过有人为了简化计算，把ω_ie设为零，结果导航结果直接报废。
最后，我分享一个个人经验：在做惯导仿真时，先把地球模型和重力场模型单独写成一个模块，用标准数据验证通过后，再集成到导航算法中。这样一旦出问题，你能快速定位是模型错了还是算法错了。别问我怎么知道的——都是血泪教训。
好了，这一章的基础知识就到这里。记住：坐标系是语言，地球模型是舞台，重力场是背景力。这三样搞不清楚，后面的误差分析就是空中楼阁。