第2章惯性导航系统原理

惯性导航系统原理

惯性导航，说白了就是靠传感器自己算位置。不用卫星，不用基站，完全自主。我当年第一次接触惯导时，觉得这东西挺神奇的——一个黑盒子，扔到哪儿都能知道自己在哪儿。后来拆开一看，里面就是加速度计和陀螺仪，再加个处理器。

嗯，咱们今天就把这三块东西讲透。

惯导的核心思想很简单：测加速度，积分得速度；测角速度，积分得姿态。你想想看，如果你知道初始位置和初始速度，再不断测量加速度，那就能算出每一时刻的位置。

公式其实就三个：

速度更新：v(t) = v(0) + ∫ a(t) dt
位置更新：p(t) = p(0) + ∫ v(t) dt
姿态更新：用陀螺仪测角速度，四元数或方向余弦矩阵更新

我在项目中遇到过一个问题：加速度计测出来的数据是「比力」，不是真正的加速度。比力 = 加速度 - 重力。所以你得先把重力分量去掉，才能积分。这个坑，很多人第一次做惯导都会踩。

⚠️ 避坑指南： 我曾经在无人机项目里，直接用加速度计原始数据积分，结果位置飞到了天上去。后来才发现——重力没补偿。记住：加速度计输出的是比力，不是加速度。

加速度计怎么测加速度？说白了就是测一个质量块的位移。

常见的MEMS加速度计，内部有个微小的质量块，用弹簧悬着。当外界有加速度时，质量块会偏移，偏移量跟加速度成正比。通过电容或压阻效应测出偏移量，就能反推出加速度。

我个人习惯，选加速度计先看两个指标：零偏稳定性和噪声密度。零偏稳不好，积分出来的速度会飘；噪声大，位置精度就上不去。

陀螺仪测角速度。原理上分两大类：

我建议初学者先搞懂MEMS振动陀螺，因为现在消费级和工业级惯导基本都用它。原理不复杂，但调起来挺折腾的。

💡 个人经验： 陀螺仪的零偏是最大的敌人。我曾经在车载导航项目里，陀螺仪零偏没校准好，车停了10分钟，航向角漂了30度。后来加了零偏在线估计，才稳住。

这两种惯导的区别，说白了就是「有没有物理平台」。

平台式惯导有一个物理的稳定平台，陀螺仪和加速度计都装在平台上。平台通过伺服电机保持水平，始终指向导航坐标系。好处是：传感器不受载体角运动影响，精度高。坏处是：体积大、重量重、成本高、机械结构复杂。

我记得在早期飞机上，平台式惯导占了半个机柜。维护一次要拆半天。

捷联式惯导没有物理平台。传感器直接固定在载体上，跟着载体一起转。那怎么知道导航坐标系下的加速度呢？靠数学计算——用陀螺仪测出的角速度，实时更新姿态矩阵，然后把加速度计测的比力投影到导航系。

说白了，就是「用数学代替物理」。我刚开始做捷联惯导时，觉得这思路太聪明了——省掉机械平台，用算法搞定一切。

现在绝大多数应用都用捷联式。为什么？因为MEMS传感器便宜了，处理器算力也够了。你想想看，一个手机里就有惯导，总不能装个平台进去吧？

  核心要点：
  捷联惯导的精度，很大程度上取决于姿态更新算法的好坏。我建议重点关注四元数更新和圆锥误差补偿。这两个搞定了，捷联惯导就稳了一半。

这张图把惯导的知识体系串起来了。左边是理论，中间是传感器，右边是系统架构。我个人建议，学习顺序应该是：先搞懂理论，再研究传感器，最后看系统架构怎么选。

嗯，惯导原理这块就讲这么多。记住一句话：惯导的核心不是传感器有多好，而是算法能不能把传感器的误差控制住。我在多个项目里验证过——同样的传感器，算法好的人能做出厘米级定位，算法差的人连米级都保不住。