1、引言：为什么需要姿态控制？——从无人机悬停说起

你有没有想过一个问题：一架四旋翼无人机，四个电机转起来，凭什么能稳稳地悬停在空中？

我刚开始接触无人机那会儿，觉得这事儿挺神奇的。四个螺旋桨呼呼一转，飞机就飘起来了。但一松遥控器，它就开始晃，然后翻跟头，最后摔地上。嗯，这就是没有姿态控制的结果。

悬停，其实是个伪命题

说白了，无人机在空中悬停，就像你用手掌托着一支笔保持平衡。笔尖朝上，你稍微抖一下，笔就倒了。无人机也一样，风一吹、重心偏一点、电机响应慢一拍，它就会倾斜、漂移、甚至炸机。

为什么会这样？因为无人机天生就不稳定。四旋翼有四个输入（四个电机的转速），但有六个自由度（前后、左右、上下、俯仰、横滚、偏航）。你想想看，输入比输出少，这系统本身就欠驱动。再加上空气动力学耦合、陀螺效应、电机延迟……悬停？不存在的。

我记得有一次在室外测试，风速大概3级。飞机刚离地1米，一阵侧风过来，它直接横滚了30度。要不是飞控反应快，那次就炸了。从那以后我深刻理解了一件事：没有姿态控制，无人机就是个会飞的砖头。

姿态控制到底在控制什么？

姿态控制，说白了就是让无人机保持我们想要的朝向。具体来说，就是三个角度：

• 俯仰角（Pitch）——机头抬起来还是低下去，控制前后运动
• 横滚角（Roll）——机身向左倾还是向右倾，控制左右运动
• 偏航角（Yaw）——机头朝哪个方向，控制旋转

这三个角度锁住了，无人机才能稳定。你遥控器一松手，飞控就要自动把这三个角度拉回零。这就是姿态控制的核心任务。

一个简单的悬停控制流程

我画了一张图，帮你理解悬停时飞控内部发生了什么：

这张图其实就讲了一件事：闭环。飞控不断读取IMU（惯性测量单元）的数据，算出当前姿态，跟期望姿态做差，然后用控制器算出差值该用多大的力去纠正，最后输出给电机。这个循环每秒跑几百次甚至上千次。

为什么不能只用开环？

有人可能会问：我直接给四个电机固定的PWM值，不也能飞起来吗？

嗯，理论上可以。但现实中，电池电压会下降、电机效率会变化、重心会偏移、风会吹……这些扰动你一个都躲不掉。开环控制就像蒙着眼睛走路，走几步还行，走远了肯定撞墙。

我曾经试过纯开环悬停，飞机在室内无风环境下勉强撑了3秒，然后就开始缓慢漂移，最后撞墙。3秒，这就是开环的极限。

姿态控制算法的选择

说到算法，市面上主流的有这么几种：

算法	核心思想	优点	缺点
PID控制	比例-积分-微分	简单、成熟、调参直观	抗扰能力一般，需要手动调参
自抗扰控制（ADRC）	估计并补偿总扰动	抗扰能力强，不依赖精确模型	参数多，调试门槛高
滑模控制（SMC）	强制状态在滑模面上运动	鲁棒性好，对参数变化不敏感	容易产生抖振
LQR控制	线性二次型最优	理论最优，适合多变量系统	需要精确模型，计算量大

我个人习惯先从PID入手。为什么？因为PID最直观，调参时你能感觉到每个参数的作用。P大了会震荡，I大了会超调，D大了会抖动。这些手感，是理解其他算法的基础。

姿态控制到底有多重要？

这么说吧，姿态控制是无人机飞控的基石。没有它，你谈什么自主飞行、航线规划、避障？都是空中楼阁。

我见过不少初学者，一上来就研究路径规划、SLAM建图，结果飞机连悬停都抖得跟筛子似的。你想想看，姿态都控不住，位置控制怎么可能准？

所以，我的建议是：先把姿态控制吃透。从PID开始，理解反馈、理解带宽、理解相位裕度。等你把姿态控制做到「飞机悬停时像钉在空中一样」，再去搞上层应用，事半功倍。

接下来的章节，我会带你逐一深入这些算法。从数学原理到代码实现，从仿真到实机调试。嗯，咱们一步一步来。

---