第2章惯性导航基本原理

第二章：惯性导航基本原理

各位同学，今天我们来聊聊惯性导航的根基。说实话，很多人一上来就盯着算法和误差补偿，却忽略了最基础的物理原理。我个人觉得，这就像盖楼不打地基——迟早要出问题。

我在刚入行那会儿，也犯过类似的错误。当时急着调代码，结果导航结果飘得离谱。后来才发现，是比力方程里的一个符号搞反了。嗯，咱们今天就把这些基础掰扯清楚。

惯性导航靠什么？说白了，就靠牛顿三大定律。尤其是第二定律：F = ma。你想想看，如果我们能测出物体受到的力，再知道质量，加速度不就出来了吗？

但在惯导系统里，我们测的不是力，而是比力。什么是比力？就是单位质量上受到的力，单位是 m/s²。加速度计输出的就是比力，不是真正的运动加速度。

核心公式：

比力 f = a - g

其中 a 是载体相对惯性空间的加速度，g 是重力加速度。

注意：加速度计测的是 f，不是 a！

我记得有一次做车载惯导测试，同事直接把加速度计读数当成运动加速度来积分，结果速度越算越大，最后飞到了天上。这就是没搞懂比力的概念。

比力方程是惯导系统最核心的方程，没有之一。它描述了载体在旋转地球上的运动规律。

完整的比力方程长这样：

a_ie = f + g - 2ω_ie × v_ie - ω_ie × (ω_ie × r)

看着复杂？咱们拆开来看：

我的经验：实际工程中，向心加速度项在高动态场景下不能忽略。我曾经在无人机上吃过这个亏，高速转弯时导航误差瞬间爆表。

哥里奥利力，说白了就是地球自转带来的“假力”。你想想看，地球在转，你在地球上运动，就会感受到这个力。

为什么叫“假力”？因为它不是真实存在的力，而是因为参考系旋转产生的惯性力。但在惯导系统里，我们必须把它算进去，否则导航结果会偏。

公式很简单：

F_c = -2m · ω × v

其中 ω 是地球自转角速度，v 是载体相对地球的速度。

避坑指南：我曾经在极地测试时，发现导航误差特别大。后来排查发现，哥里奥利力在极地附近会变得非常显著。如果你做极地导航，一定要把这项算准。

举个例子：你从赤道向北发射一枚导弹，如果没有补偿哥里奥利力，导弹会向东偏。这就是为什么远程武器必须考虑地球自转。

好了，前面讲了物理原理，现在咱们搭数学框架。惯导系统的数学框架，说白了就是三个核心方程：

这三个方程是串行执行的：先算姿态，再用姿态算速度，最后用速度算位置。一步错，步步错。

数学框架的核心流程：

陀螺仪 → 姿态更新 → 姿态矩阵

加速度计 → 比力投影 → 速度更新 → 位置更新

每一步都依赖上一步的结果，这就是惯导的“递推”本质。

下面我画了一张图，帮你理清整个知识体系：

这张图把整个知识体系串起来了。你从牛顿力学出发，理解比力和哥里奥利力，然后搭起数学框架。框架里三个方程环环相扣，缺一不可。

我的建议：初学者先别急着写代码。把这三个方程在纸上推导一遍，搞清楚每个符号的含义。我当年就是这么干的，虽然花了两天时间，但后面写代码时思路特别清晰。

好了，这一章的内容就到这里。记住：惯导的本质就是积分，积分的起点就是这些基础方程。基础不牢，地动山摇。

公众号:蓝海资料掘金营，微信deep3321