4. 惯性导航系统（INS）：陀螺仪与加速度计原理、硬件接口、误差补偿

各位同学，今天我们聊惯性导航系统。说白了，这就是导弹的“内耳”——它不依赖任何外部信号，全靠自己感知运动。我做了这么多年导弹控制，可以负责任地告诉你：INS是导弹自主性的基石。没有它，导弹就是个瞎子。

4.1 陀螺仪原理：角速度的感知

陀螺仪测量的是角速度，也就是导弹转得有多快。为什么叫“陀螺”？因为最早的机械式陀螺确实像个陀螺玩具，利用定轴性来测量。

但现在，我们基本都用MEMS陀螺仪了。它的原理是科里奥利效应——一个振动的质量块，当它旋转时，会受到一个垂直于振动方向的力。这个力的大小正比于角速度。

嗯，这里要注意：MEMS陀螺仪的输出是模拟电压或数字信号，但千万别直接拿来用。我见过一个新手，直接把陀螺仪原始数据积分算角度，结果导弹还没飞出去，角度就漂到天上去了。

4.2 加速度计原理：线加速度的测量

加速度计测量的是比力——也就是物体受到的惯性力与重力的合力。原理很简单：一个质量块挂在弹簧上，加速度会让它位移，位移量正比于加速度。

现代MEMS加速度计用的是电容式检测。质量块移动时，电容变化，通过电路转换成电压。我习惯用ADI的ADXL系列，稳定性不错。

4.3 硬件接口：SPI与I²C的选择

陀螺仪和加速度计通常通过SPI或I²C与主控通信。我个人偏好SPI，为什么？

• SPI：全双工，速度快，适合高数据率场景。导弹控制中，角速度数据通常需要1kHz以上采样率，SPI是首选。
• I²C：只需要两根线，但速度慢，且容易受干扰。我一般只在调试时用I²C。

来看一个典型的SPI读取代码片段：

// SPI读取陀螺仪角速度数据
uint8_t spi_read_gyro(uint8_t reg) {
    uint8_t data;
    CS_LOW();  // 片选拉低
    spi_transfer(reg | 0x80);  // 读命令
    data = spi_transfer(0x00); // 读取数据
    CS_HIGH(); // 片选拉高
    return data;
}

你想想看，如果这里片选时序没处理好，数据就会错位。我调试时吃过这个亏，后来习惯用逻辑分析仪先抓波形。

4.4 误差补偿：INS的命门

INS的误差主要来自三个方面：

1. 零偏误差：静止时输出不为零。我习惯在导弹上电后做静态校准，采集1000个样本取平均。
2. 标度因数误差：输出与实际值的比例关系不准。这需要六位置法标定。
3. 随机游走：噪声积分导致的漂移。这是最难处理的，通常用卡尔曼滤波。

误差补偿的流程，我画了一张图：

这张图展示了完整的误差补偿链路。你看，原始数据进来后，先做零偏补偿，再做标度因数补偿，然后温度补偿，最后进卡尔曼滤波。每一步都不能省。

4.5 实战经验：IMU选型与布局

选IMU时，我一般看三个指标：

指标	战术导弹要求	常见MEMS水平
陀螺仪零偏稳定性	< 1°/h	5-20°/h
加速度计零偏	< 1 mg	5-50 mg
角度随机游走	< 0.1°/√h	0.3-1.0°/√h

嗯，这里要注意：战术导弹对IMU的要求远高于消费级。我建议至少选用工业级MEMS，比如ADI的ADIS系列或Honeywell的HG系列。

最后说一句：INS的误差补偿是个系统工程，不是调几个参数就能搞定的。你需要理解物理原理，熟悉硬件特性，还要有耐心做大量测试。我在项目中，光零偏标定就做了三天三夜。

好了，今天就到这里。记住：INS是导弹的“内耳”，你得把它伺候好了，它才能带你飞得准。

---