1. 串级PID控制原理与工程实现基础
四轴飞行器的姿态控制本质上是一个多输入多输出（MIMO）的非线性系统。其核心挑战在于：电机转速与升力呈平方关系（$F \propto \omega^2$），而姿态角（横滚、俯仰、偏航）与升力矩之间又存在复杂的耦合动力学。当仅采用单级PID控制时，控制器直接将期望姿态角与IMU解算出的实际姿态角做差，生成控制量驱动电机。这种结构在小角度、缓变指令下表现良好，但一旦遭遇大角度阶跃响应（如遥控器摇杆从0°猛推至30°）或高频扰动（如阵风），系统便暴露出根本性缺陷——动态响应滞后与稳态误差累积。
问题根源在于姿态角的物理本质。IMU通过陀螺仪角速度积分和加速度计数据融合得到姿态角，该过程本身引入了相位延迟。更关键的是，角速度是姿态角对时间的一阶导数（$\omega = \frac{d\theta}{dt}$）。在离散控制系统中，采样周期$T_s$（本例为5ms）构成了隐含的时间微分尺度。这意味着，当外环PID计算出一个角度偏差$\Delta\theta$后，其输出量在数值上已天然蕴含了角速度信息：$\omega_{ref} \approx \frac{\Delta\theta}{T_s}$。这一数学事实为串级控制提供了坚实的理论基础——外环输出可直接作为内环的角速度期望值。
串级PID由此形成双闭环结构：外环（角度环）负责消除姿态角的稳态误差，内环（角速度环）则利用陀螺仪直接测量的高带宽角速度信号，实现对动态变化的快速响应。陀螺仪的动态性能远优于姿态解算，其原始数据带宽可达数百Hz，对瞬时扰动的响应时间在毫秒级。相比之下，姿态解算需融合低带宽的加速度计数据以抑制陀螺仪漂移，导致整体响应迟滞。因此，角速度环成为整个控制系统的“高速通道”
