IMU学习
🛠️ 第一部分：传感器的底裤（它是干什么的）
IMU 就像是火箭的“小脑”，核心由两组（六轴）或三组（九轴）微型传感器组成：
加速度计（测“受力”）：测量直线方向上的加速度。
看家本领：静态时能感受到“地心引力”，利用重力在坐标轴上的分摊，通过反正切函数反推出火箭偏离垂直线的绝对倾斜角。
死穴：极度怕震动（发动机一抖，数据就乱跳）。
陀螺仪（测“转速”）：测量设备旋转的角速度（°/s）。
看家本领：动态时极其平滑精准，完全不怕直线震动。
死穴：“零点漂移”，不认东南西北。要算角度只能靠速度 $\times$ 时间进行积分，时间一长，微小的误差就会无限累积（漂移）。
算法融合（卡尔曼滤波）：单片机把两者结合，运动时相信陀螺仪，静止时用加速度计修正陀螺仪的漂移，取长补短。
🧭 第二部分：六轴模式 vs 九轴模式（关键选型）
这两者最核心的区别在于：怎么处理 Z 轴（自转/航向角）的角度。
| 属性 | 六轴算法（加速度计 + 陀螺仪） | 九轴算法（六轴 + 磁力计/指南针） |
| Z轴角度含义 | 相对角度（相当于秒表） | 绝对角度（相当于真指南针） |
| 0° 的物理意义 | 你在哪里点【设置零位】，哪里就是 0° | Y轴精准指向地理磁北时才是 0° |
| 软件置零按钮 | 有效，随时可以强制归零 | 无效，不以人的意志为转移 |
| 它的死穴 | Z 轴时间长了会产生累计误差（漂移） | 极度怕强磁和电流干扰（20cm内必死） |
🚀 火箭项目锁死【六轴模式】的根本原因：
九轴虽然能通过“磁力针”建立绝对坐标系，知道 X 和 Y 轴指向地球的东南西北。但火箭内部有大电流、动力电池、以及频繁摆动的舵机（全是强磁干扰源）。如果开九轴，磁力计会被瞬间“闪瞎”，导致整个解算崩溃。
而火箭升空只需要 X 和 Y 轴保持垂直，Z 轴（自转）就算有漂移或者像钻头一样转圈，完全不影响火箭直刺苍穹！
📐 第三部分：空间感与角度理解（如何写控制代码）
在软件设置为“水平安装”时，IMU 平放，Z 轴直指天空（火箭头部）。
1. 独立运行的 X 轴与 Y 轴
X 轴（俯仰 Pitch）：负责前后点头。
Y 轴（横滚 Roll）：负责左右摇摆。
物理独立：它们各过各的，完全可以出现 $X = 60^{\circ}$（向前暴倾）、$Y = 0^{\circ}$（左右完美对称不歪）的情况。
2. 角度的范围与正负（$\pm180^{\circ}$）
算法不是量两根线的夹角，而是以垂直于地面的那根线作为 0° 起跑线，通过重力向量的正负号来判断方向：
往正方向倒：数字变正数（$+1^{\circ}, +2^{\circ}, +3^{\circ} \dots$ 直到横躺的 $+90^{\circ}$）。
往反方向倒：数字变负数（$-1^{\circ}, -2^{\circ}, -3^{\circ} \dots$ 直到横躺的 $-90^{\circ}$）。
分界线：火箭完全倒栽葱（底朝天）时，度数在最底端汇合。
179.9°跨过去就会瞬间突变成-179.9°。
3. TVC（推力矢量）控制的伪代码逻辑：
在实际飞行中，你只需要让 PID 控制环盯着0° 附近（$\pm5^{\circ}$）的微小晃动：
C
// 目标：让 X 和 Y 轴的 Error 永远趋近于 0 if (Angle_X > 0) Move_Servo_X_Negative(); // 火箭向前歪，喷嘴向前顶 if (Angle_X < 0) Move_Servo_X_Positive(); // 火箭向后歪，喷嘴向后顶 if (Angle_Y > 0) Move_Servo_Y_Negative(); // 火箭向左歪，喷嘴向左顶 if (Angle_Y < 0) Move_Servo_Y_Positive(); // 火箭向右歪，喷嘴向右顶 // Z轴角度变动？火箭在自转，随它去，喷嘴不需要做任何补偿！🎯 第四部分：关于“轨迹”的现实幻灭
双重积分的陷阱：理论上对加速度积分一次得速度，积分两次得轨迹。但由于廉价 IMU 存在初始误差（Noise），位置误差会随时间的平方（$t^2$）级爆炸放大。单靠 IMU，火箭起飞一分钟后测出来的轨迹就会偏出几百米。
火箭轨迹的正确解法（外援融合）：1. 垂直高度（Z轴轨迹）：直接读 IMU 模块里内置的气压计数据。
2. 水平移动（X/Y轴轨迹）：外接一个GPS 模块传回地面。