071、姿态控制：俯仰通道设计

飞控算法从入门到精通 | 071 姿态控制：俯仰通道设计

一、一次炸机事故的教训

去年夏天，我在调试一架四旋翼时遇到一个诡异现象：悬停时飞机每隔3秒左右会突然抬头，然后猛地低头修正，像在“点头哈腰”。地面站日志显示俯仰角误差在±2度内震荡，但角速度曲线却出现了明显的相位滞后。当时我以为是PID参数没调好，反复调整P和D，结果越调越糟——飞机在第三次试飞时直接翻了过去，桨叶碎了一地。

事后复盘才发现，问题出在俯仰通道的“控制分配”环节：我把俯仰力矩直接映射到了前后电机的PWM差值上，却忽略了电机响应延迟带来的相位偏移。这个教训让我意识到，俯仰通道设计远不止调三个PID参数那么简单。

二、俯仰通道的物理本质

俯仰控制的核心是绕机体Y轴的力矩平衡。对于常规四旋翼，俯仰力矩由前后电机推力差产生：

M_pitch = L * (T_front - T_rear)

其中L是电机到重心的力臂。但这里有个容易被忽视的细节：电机推力T与PWM占空比并非线性关系。我实测过某款2212电机，在50%油门附近，推力曲线斜率比30%油门处陡了将近40%。如果你用固定增益去映射，低油门时控制量不足，高油门时又容易超调。

更麻烦的是，电机响应存在一阶惯性环节。我用示波器抓过电机转速阶跃响应，从PWM变化到推力稳定大约需要80ms——这个延迟在姿态控制环里会引入额外的相位滞后。俯仰通道的带宽通常设计在5-10Hz，80ms延迟意味着在10Hz频率点已经产生了约45度的相位偏移。