073、姿态控制：解耦与耦合分析

飞控算法从入门到精通 | 073 姿态控制：解耦与耦合分析

一、从一次炸机说起

去年调试一架四轴，PID参数调得差不多了，悬停稳如老狗。结果一打横滚，飞机直接翻了个跟头栽下来。检查日志发现：横滚指令发出后，俯仰通道瞬间出现了20度的偏差，偏航也跟着抖了一下。这就是典型的姿态耦合——你以为在控制一个轴，实际上三个轴都在打架。

很多新手调PID只盯着单通道响应，忽略了轴间耦合。飞控里最坑的地方就在这里：你调好了横滚，一飞俯仰又崩了；你调好了偏航，横滚又开始震荡。这不是PID参数的问题，是耦合没处理好。

二、耦合的本质：旋转不是独立的

先想清楚一件事：四旋翼的姿态控制，本质上是在三维空间里控制刚体旋转。刚体旋转有个特性——绕不同轴的转动会相互影响，因为角速度是矢量，而旋转矩阵是非线性的。

具体到飞控里，耦合分两种：

1. 动力学耦合
电机产生的力矩，理论上只绕机体轴。但实际飞行中，一个轴的角速度变化会通过陀螺效应、气动阻尼等机制影响其他轴。比如横滚快速转动时，螺旋桨的陀螺力矩会施加到俯仰轴上，产生一个交叉耦合项。

2. 控制耦合
更常见的是控制分配层面的耦合。四旋翼的四个电机，每个电机同时影响三个轴的力矩。你给横滚通道加一个增量，四个电机的转速都要变，这个变化会同时改变俯仰和偏航的力矩。如果混控矩阵设计得不好，或者电机响应不一致，耦合就来了。

我见过最离谱的情况：某飞控的混控矩阵里，横滚和偏航的系数写反了，导致打横滚时偏航跟着转，飞机原地