四旋翼ADRC姿态控制原理与工程实践

1. 四旋翼ADRC姿态控制的"玄学"面纱

第一次接触四旋翼ADRC（自抗扰控制）姿态控制时，我和大多数人一样，面对密密麻麻的参数表有种深深的无力感。那些看起来随意调整的β1、β2、β3参数，以及观测器带宽、控制器带宽的微妙配合，确实容易让人产生"玄学调参"的错觉。但当我真正拆解了整个控制链条后，才发现这套系统背后有着严谨的数学基础和清晰的物理意义。

ADRC之所以在四旋翼控制领域备受青睐，核心在于它能够有效处理系统的"未知扰动"。四旋翼飞行时面临的风扰、模型不确定性、传感器噪声等，都可以被ADRC的扩张状态观测器(ESO)实时估计并补偿。这种"总扰动"的处理思路，比传统的PID控制更加符合实际工程需求。

滚转通道的角加速度方程是理解ADRC控制逻辑的钥匙。这个看似简单的二阶微分方程，实际上包含了四旋翼姿态动力学的精髓。当我们写出这个方程时，就已经为后续的控制器设计奠定了模型基础。方程中的各项参数——转动惯量、升力系数、电机力矩常数等，都是连接数学模型与实际物理系统的桥梁。

2. 从物理模型到数学表达的完整推导

2.1 滚转通道的动力学本质

四旋翼的滚转运动本质上是由四个旋翼产生的力矩不平衡引起的。假设我们有一个标准的"+"型四旋翼，1号和3号电机控制滚转运动。当这两个电机转速不同时，就会产生绕x轴的滚转力矩。

根据牛顿第二定律和欧拉方程，滚转角加速度φ̈可以表示为：

code复制φ̈ = (τ_x + τ_d)/I_xx

其中：

• τ_x = l(F3 - F1) 是由电机产生的控制力矩（l为力臂长度）
• τ_d 代表所有未知扰动力矩的总和
• I_xx 是绕x轴的转动惯量

这个方程看似简单，却包含了控制设计所需的全部信息。关键在于如何处理τ_d这个扰动项——这正是ADRC大显身手的地方。

2.2 电机力与PWM信号的转换

在实际系统中，我们控制的不是直接的力F，而是电机的PWM信号。因此需要建立从PWM到升力的映射模型。通过实验测量，我们发现电机升力与PWM信号大致呈二次关系：

code复制F_i = k_f * PWM_i² (i=1,2,3,4)

其中k_f是升力系数，需要通过实验标定。这个非线性关系在实际控制中必须考虑，特别是在大机动飞行时。

2.3 完整的状态空间表达

为了应