第3章 传感器冗余（IMU）：双IMU与三IMU架构设计、数据交叉比对、故障检测与隔离（FDI）
传感器冗余，说白了就是给飞控系统多装几双「眼睛」。IMU作为飞控最核心的感知单元，一旦出问题，后果就是炸机。我见过太多因为单IMU故障导致的坠毁案例，所以这一章，咱们重点聊聊双IMU和三IMU的架构设计，以及如何做故障检测与隔离。
3.1 为什么需要IMU冗余？
IMU包含加速度计和陀螺仪，它们都是MEMS器件。MEMS这东西，说白了就是微小的机械结构，容易受温度、振动、冲击影响。我在项目中遇到过一块IMU在低温下零偏漂移超过正常值10倍的情况，单IMU根本没法判断是飞机在动还是传感器坏了。
冗余设计的目的很简单：让系统在单个传感器失效时，依然能输出正确的姿态和位置信息。你想想看，如果双IMU数据不一致，系统至少能知道「出问题了」，然后决定信任谁。
3.2 双IMU架构设计
双IMU是最常见的冗余方案。成本可控，实现难度适中。我个人习惯把双IMU分为两种模式：主备模式和交叉校验模式。
3.2.1 主备模式
一个IMU作为主传感器，另一个作为热备份。主IMU正常工作时，备份IMU的数据只做监控，不参与控制。一旦主IMU被判定为故障，系统立即切换到备份IMU。
这种模式的好处是简单，控制逻辑不用改。但缺点也很明显——切换瞬间可能会有数据跳变。我曾经遇到过切换时姿态角突然跳了3度，飞机直接抖了一下。
3.2.2 交叉校验模式
两个IMU同时工作，数据实时交叉比对。如果差值超过阈值，触发故障处理流程。这种模式更可靠，但需要更复杂的算法。
具体做法是这样的：
- 两个IMU的加速度计和陀螺仪数据分别做时间对齐
- 计算差值：Δacc = |acc1 - acc2|，Δgyro = |gyro1 - gyro2|
- 如果Δacc > 阈值 且 Δgyro > 阈值，持续超过N个采样周期，判定为故障
3.3 三IMU架构设计
三IMU架构，说白了就是「少数服从多数」。三个IMU的数据做投票表决，能容忍一个传感器故障。这种架构在高端无人机和载人飞行器上很常见。
三IMU的布局方式，我推荐正交安装。什么意思？三个IMU的敏感轴互相垂直。这样做的目的是：如果某个方向的振动特别大，至少有两个IMU不受影响。
数据融合策略是这样的：
- 对三个IMU的数据做两两交叉比对，得到三组差值
- 如果某组差值超过阈值，标记对应的IMU对为「不一致」
- 统计每个IMU被标记的次数，被标记最多的那个就是可疑故障源
- 剔除故障IMU，用剩余两个IMU的数据做平均
3.4 数据交叉比对算法
数据交叉比对，核心就是一致性检查。我常用的方法有两种：
3.4.1 基于欧拉角的比对
把两个IMU的角速度积分成欧拉角，然后直接比较角度差。这种方法直观，但积分会累积误差。长时间飞行后，两个IMU的欧拉角差异会越来越大，容易误报。
3.4.2 基于四元数的比对
四元数没有欧拉角的万向锁问题，而且计算量小。我一般用四元数做比对：
// 四元数差值计算
float q_diff = fabs(q1.w * q2.w + q1.x * q2.x + q1.y * q2.y + q1.z * q2.z);
// 如果q_diff接近1，说明两个四元数一致
// 如果q_diff小于阈值（比如0.999），说明差异过大嗯，这里要注意：四元数比对时，要考虑符号问题。q和-q代表同一个旋转，所以要先做符号归一化。
3.5 故障检测与隔离（FDI）
FDI是冗余设计的灵魂。没有FDI，冗余就是摆设。我把它分为三个步骤：
3.5.1 故障检测
故障检测的指标，我常用这几个：
- 数据有效性检查： 检查IMU的SPI/I2C通信是否正常，数据是否在合理范围内
- 一致性检查： 两个或三个IMU的数据是否一致
- 自检结果： IMU芯片内部的自检（Built-In Self-Test）结果
3.5.2 故障隔离
一旦检测到故障，就要把故障IMU从控制回路中隔离出去。隔离的方式有两种：
| 隔离方式 | 适用场景 | 优缺点 |
|---|---|---|
| 软件隔离 | 双IMU或三IMU | 灵活，但需要修改数据融合算法 |
| 硬件隔离 | 高安全等级系统 | 彻底，但增加硬件成本 |
我个人习惯先用软件隔离，如果故障持续存在，再考虑硬件隔离。因为硬件隔离意味着要切断电源或断开通信，操作不可逆。
3.5.3 故障恢复
故障恢复是个容易被忽略的点。IMU的故障可能是瞬时的（比如受到强振动），也可能是永久的。我建议这样处理：
- 瞬时故障：隔离后，如果数据恢复正常，可以重新接入
- 永久故障：隔离后不再接入，直到系统重启
怎么区分瞬时和永久？我一般设一个计时器。如果故障持续超过5秒，就判定为永久故障。
3.6 架构对比与选型建议
说了这么多，到底选双IMU还是三IMU？我根据项目经验总结了一张表：
| 架构 | 成本 | 可靠性 | 实现难度 | 适用场景 |
|---|---|---|---|---|
| 单IMU | 低 | 低 | 低 | 玩具级无人机 |
| 双IMU（主备） | 中 | 中 | 中 | 消费级无人机 |
| 双IMU（交叉校验） | 中 | 较高 | 较高 | 工业级无人机 |
| 三IMU | 高 | 高 | 高 | 载人飞行器、军用无人机 |
我的建议是：如果你的产品是消费级，双IMU交叉校验就够了。如果是工业级或更高安全等级，直接上三IMU。别为了省那几十块钱的成本，把整个系统的可靠性搭进去。
3.7 本章知识体系
下面这张图，是我对本章核心逻辑的总结：
这张图从顶层架构到底层实现方法，把IMU冗余设计的全貌展示出来了。你照着这个框架去落地，基本不会跑偏。