3、姿态表示方法：欧拉角（万向锁问题）、旋转矩阵、四元数（优缺点对比）
姿态表示，说白了就是怎么描述飞机当前「脑袋朝哪、肚皮朝哪」。
我刚开始做飞控那会儿，觉得这玩意儿不就是三个角度嘛，有啥好纠结的？后来真上了硬件，才发现选错表示方法，轻则姿态解算出bug，重则飞机直接翻跟头。嗯，今天咱们就把三种主流方法掰开揉碎了聊。
3.1 欧拉角：最直观，但最危险
欧拉角就是大家熟悉的 pitch（俯仰）、roll（横滚）、yaw（偏航）。三个角度，简单粗暴。
优点：
- 物理意义极其清晰——看一眼数值就知道飞机姿态
- 占用内存小，只需要3个float
- 人机交互友好，遥控器、地面站都用它
但我要说个坑。欧拉角有个致命缺陷——万向锁（Gimbal Lock）。
什么是万向锁？我举个例子。你想象飞机先抬头90度（pitch=90°），这时候飞机的机头指向正上方。你再转yaw，会发现飞机只是在原地「拧身子」，根本改变不了指向。三个自由度，硬生生丢了一个。
⚠️ 万向锁的本质：
当pitch接近±90°时，roll和yaw的旋转轴重合，导致系统失去一个自由度。这不是数值问题，是数学上的奇点。
我曾经在调试一款竞速无人机时，飞手做大角度俯冲，结果姿态解算直接炸了——因为欧拉角微分方程在奇点附近会发散。从那以后，我内部运算再也不敢只用欧拉角。
另外，欧拉角的旋转顺序也很关键。常见的顺序有ZYX、ZXY等。不同顺序，同一个角度组合代表不同姿态。你想想看，如果代码里用的ZYX，地面站用的ZXY，那飞机不乱飞才怪。
3.2 旋转矩阵：数学上完美，但太「重」
旋转矩阵是一个3×3的正交矩阵，行列式为+1。它没有奇点，可以表示任意姿态。
优点：
- 无奇点，全姿态覆盖
- 组合旋转方便——矩阵乘法即可
- 数值稳定性好，适合做积分
但缺点也很明显：
- 9个参数，冗余度高。每次更新都要保证正交性，否则矩阵会「漂移」
- 计算量大。嵌入式MCU上做3×3矩阵乘法，一次就是9次乘加
- 不直观。你看着9个数，能想象出飞机姿态吗？反正我不能
我个人的习惯是：内部解算用四元数，输出给用户时转成欧拉角。旋转矩阵嘛，偶尔在坐标变换时用一下，但不会作为主姿态量。
3.3 四元数：飞控界的「万金油」
四元数是个超复数，形式为 q = w + xi + yj + zk，其中 w 是实部，x、y、z 是虚部。约束条件是 w² + x² + y² + z² = 1。
说白了，四元数就是用4个数表示一个旋转。它没有奇点，计算效率高，是现代飞控的标配。
优点：
- 无万向锁——这是最大的优势
- 计算量适中——比旋转矩阵少，比欧拉角多一点点
- 插值平滑——做姿态平滑、轨迹规划时特别好用
- 数值稳定性好——只需要做归一化就能保持有效
缺点嘛：
- 不直观。你看着 [0.707, 0, 0.707, 0]，能知道飞机朝哪吗？反正我不能
- 理解门槛高。刚接触的人容易搞混共轭、逆、乘法顺序
- 调试麻烦。出了问题，你很难从四元数数值上看出问题
💡 我的经验：
四元数乘法不满足交换律。也就是说 q1 * q2 和 q2 * q1 结果不同。我在项目中遇到过因为乘法顺序搞反，导致姿态补偿方向完全反了的情况。那次排查了整整两天，最后发现是代码里把「先旋转再补偿」写成了「先补偿再旋转」。
3.4 三种方法对比总结
| 特性 | 欧拉角 | 旋转矩阵 | 四元数 |
|---|---|---|---|
| 参数数量 | 3 | 9 | 4 |
| 奇点问题 | 有（万向锁） | 无 | 无 |
| 计算效率 | 高 | 低 | 中 |
| 直观性 | 高 | 低 | 低 |
| 插值平滑 | 差 | 中 | 好 |
| 数值稳定性 | 差（奇点附近） | 中（需正交化） | 好（归一化即可） |
| 适用场景 | 人机交互、显示 | 坐标变换、理论推导 | 姿态解算、控制 |
3.5 实际工程中的选择建议
我个人的工程实践是这样的：
- 姿态解算（IMU融合）：用四元数。Mahony、Madgwick算法都是基于四元数的，效率高、无奇点
- 姿态控制：用四元数或旋转矩阵。现代控制理论（如几何控制）直接操作SO(3)，效果更好
- 用户交互：转成欧拉角。地面站、遥控器、日志分析，都用欧拉角
- 坐标变换：用旋转矩阵。多个坐标系嵌套时，矩阵乘法比四元数乘法更直观
⚠️ 避坑指南：
我曾经在PX4的代码里看到过，内部姿态估计用的是四元数，但输出给EKF时转成了欧拉角，然后又转回四元数。这种来回转换会引入精度损失和奇点风险。我的建议是：选定一种主表示方法，全程使用，只在边界处转换。
最后说一句。没有完美的姿态表示方法，只有最适合当前场景的。你想想看，欧拉角虽然危险，但地面站离了它不行；四元数虽然不直观，但飞控离了它也不行。理解每种方法的优缺点，在合适的场景用合适的工具，这才是工程师该有的思维。