第2章惯性导航系统原理

惯性导航系统，说白了就是一套「自己给自己定位」的设备。它不依赖任何外部信号，全靠内部的加速度计和陀螺仪来推算位置。我刚开始接触这个领域时，觉得这玩意儿挺神奇的——飞机钻山洞、潜艇下深海，GPS信号全丢了，它还能继续报位置。

它的核心原理其实很简单：牛顿力学。加速度计测出三个轴向的加速度，陀螺仪测出三个轴向的角速度。然后通过积分运算，把加速度积成速度，再把速度积成位置。嗯，这里要注意——积分一次就有漂移，积分两次漂移更明显。

核心公式（简化版）：

速度 = ∫(加速度 - 重力) dt
位置 = ∫(速度) dt
姿态 = ∫(角速度) dt

说白了就是：你每走一步，系统都在算「我从哪里来，要到哪里去」。

我在项目中遇到过一件事：某次地面测试，IMU（惯性测量单元）输出的加速度数据看起来很正常，但导航结果却偏得离谱。查了两天才发现——重力补偿没做对。你想想看，加速度计测的是「比力」，不是纯粹的加速度。如果不把重力分量去掉，积分出来的速度会一直往上飘。

做惯导的人都知道一句话：误差是惯导的宿命。为什么？因为它是积分系统，误差会随时间累积。我习惯把误差源分成三大类，这样排查起来比较清晰。

这是最底层的误差，来自传感器本身。主要包括：

避坑指南：我曾经在选型时只看零偏指标，忽略了随机游走。结果在长时间导航测试中，位置误差比预期大了三倍。后来我学乖了——一定要看Allan方差曲线，它告诉你噪声的「底色」是什么。

惯导系统启动时，需要知道初始位置、初始速度和初始姿态。如果这些初始值不准，后面的积分就是「错上加错」。

我记得有一次做车载测试，系统启动后导航结果一直偏东。查了半天，发现是初始航向角差了0.1度。你想想看，0.1度的航向误差，跑10公里后横向偏差就是17米。对于导弹来说，这已经够脱靶了。

初始对准通常分两步：

这部分容易被忽略，但实际影响不小。主要包括：

注意：圆锥效应补偿不是可选项，是必选项。我曾经见过一个团队，因为没做圆锥补偿，导弹在转弯时导航误差直接爆表。嗯，后来他们改方案了。

做惯导系统这么多年，我总结了几种最常见的故障模式。这些故障不是「会不会发生」的问题，而是「什么时候发生」的问题。

我特别想说说数据跳变这个故障。有一次在飞行试验中，惯导系统突然报出巨大的加速度值，导致导航位置瞬间跳了几百米。后来分析发现，是CAN总线上的一个数据包被电磁干扰破坏了。从那以后，我坚持在软件里加一个「速率限制器」——任何物理量都不可能瞬间变化，超过阈值就直接丢弃。

故障诊断的黄金法则：

我习惯把这三点写成固化代码，每次上电自动运行。说白了，就是让系统自己先「体检」一遍。

既然误差和故障都不可避免，那就要考虑容错。我个人的经验是：不要指望单个传感器永远正确。

常用的容错方法包括：

一个小技巧：我曾经在项目中用「滑动窗口方差检测」来识别故障。具体做法是——保存最近100个采样点的方差，如果当前点的偏差超过3倍方差，就判定为异常。这个方法简单有效，而且计算量很小。

嗯，关于惯性导航系统的原理、误差和故障，今天就先聊到这儿。下一章我会详细讲卡尔曼滤波在惯导中的应用——那才是真正把「脏数据」变成「干净导航结果」的核心技术。

第2章 惯性导航系统原理