四旋翼姿态控制：PID与ADRC算法对比与实践

1. 四旋翼姿态控制的核心挑战

四旋翼飞行器的姿态控制本质上是一个多变量、强耦合的非线性系统控制问题。当我在实验室第一次调试自制四旋翼时，最直观的感受就是：调整横滚角时俯仰角会跟着漂移，改变偏航角时另外两个轴也会产生联动。这种耦合特性源于飞行器的物理结构——四个旋翼产生的升力需要通过复杂的力矩组合来实现三轴控制。

姿态动力学方程可以表示为：

code复制I_x * φ̈ = (I_y - I_z) * θ̇ * ψ̇ + τ_φ + d_φ
I_y * θ̈ = (I_z - I_x) * φ̇ * ψ̇ + τ_θ + d_θ 
I_z * ψ̈ = (I_x - I_y) * φ̇ * θ̇ + τ_ψ + d_ψ

其中I表示转动惯量，τ为控制力矩，d代表外部扰动。这个方程揭示了三轴运动之间的非线性耦合关系，也是所有控制算法需要解决的核心问题。

2. 经典PID控制的实现与局限

2.1 串级PID结构设计

在实际工程中，最常用的是串级PID结构。内环控制角速度，外环控制角度，形成双闭环控制。以俯仰角为例：

code复制角度环(外环):
e_θ = θ_d - θ_actual
ω_d = Kp_θ*e_θ + Ki_θ*∫e_θdt + Kd_θ*de_θ/dt

角速度环(内环): 
e_ω = ω_d - ω_actual
U_θ = Kp_ω*e_ω + Ki_ω*∫e_ωdt + Kd_ω*de_ω/dt

2.2 PID参数整定经验

经过多次飞行测试，我总结出以下调参经验：

1. 先调内环再调外环
2. 先比例后积分最后微分
3. 角速度环Kp通常比角度环大一个数量级
4. 积分项要谨慎设置，避免积分饱和

2.3 实际应用中的问题

在室外测试时发现，当风速超过5m/s时，传统PID会出现明显振荡。这是因为：

1. 固定参数无法适应动态扰动
2. 耦合效应导致误差累积
3. 微分项对噪声敏感

3. 自抗扰控制(ADRC)的创新突破

3.1 ADRC的核心组件

ADRC通过三个关键部件解决上述问题：

1. 跟踪微分器(TD)
   安排过渡过程，解决快速性与超调矛盾

   code复制v1(k+1) = v1(k) + h*v2(k)
   v2(k+1) = v2(