四旋翼无人机ADRC控制与Simulink仿真实践

1. 四旋翼无人机与ADRC控制器的技术背景

四旋翼无人机作为一种典型的欠驱动系统，其姿态控制一直是飞行控制领域的核心挑战。与传统PID控制相比，自抗扰控制(ADRC)因其对系统内外扰动的强鲁棒性，近年来在无人机控制领域获得了广泛关注。

ADRC的核心思想源自韩京清教授提出的"总扰动"概念，它将系统未建模动态、外部干扰和参数变化统一视为总扰动，通过扩张状态观测器(ESO)进行实时估计并补偿。这种控制策略特别适合四旋翼这类存在强耦合和非线性特性的系统。

在Matlab/Simulink环境下搭建ADRC控制器具有独特优势：

• 可视化建模：通过Simulink框图可直观展现ADRC的三级结构（TD跟踪微分器+ESO+NLSEF非线性控制律）
• 参数调试便利：Matlab脚本可批量测试不同观测器带宽和控制参数组合
• 物理意义明确：各模块输入输出信号可直接对应实际飞行器的角速度、欧拉角等物理量

实际工程经验表明，ADRC参数整定中ESO带宽的选择尤为关键。带宽过低会导致扰动估计滞后，过高则放大测量噪声。通常建议从系统自然频率的3-5倍开始调试。

2. Simulink仿真环境搭建要点

2.1 四旋翼动力学建模

完整的仿真需要建立六自由度刚体动力学模型，核心包括：

matlab复制% 旋转动力学方程示例
I = diag([0.03, 0.03, 0.04]); % 惯性矩阵(kg·m²)
omega = [p; q; r]; % 机体角速度(rad/s)
tau = [tau_phi; tau_theta; tau_psi]; % 控制力矩(N·m)

omega_dot = inv(I)*(tau - cross(omega, I*omega)); % 欧拉动力学方程

2.2 ADRC模块化实现

建议将ADRC分解为可复用的子系统：

1. TD跟踪微分器：安排过渡过程，避免设定值跳变

   simulink复制% 二阶TD的S函数实现
   function sys = mdlDerivatives(t,x,u)
       r = 100; h = 0.01; % 速度因子和滤波因子
       sys(1) = x(2);
       sys(2) = -r*sign(x(1)-u