四旋翼无人机ADRC姿态控制原理与实践

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

四旋翼无人机的姿态控制本质上是一个多变量、强耦合的非线性系统控制问题。当我在2018年第一次尝试用传统PID控制器实现姿态稳定时，遇到了三个典型问题：

1. 抗扰动能力差：室外飞行时突风扰动导致姿态角波动超过15度
2. 动态响应慢：从悬停到最大倾角需要0.8秒响应时间
3. 参数整定困难：三个轴向的PID参数互相影响，调参耗时长达两周

这些痛点促使我转向ADRC（自抗扰控制）方案。与传统PID相比，ADRC通过扩张状态观测器(ESO)实时估计并补偿系统内外部扰动，其核心优势在于：

• 对模型精度依赖度低
• 抗扰动能力强
• 参数整定更具规律性

2. 无人机姿态动力学建模

2.1 机体坐标系定义

建立正确的坐标系是建模的基础。我采用右手坐标系定义：

• X轴：机头前进方向
• Y轴：右侧机臂方向
• Z轴：垂直向下（符合航空航天惯例）

2.2 欧拉角动力学方程

通过牛顿-欧拉方程推导，得到姿态角加速度方程：

code复制φ̈ = [τ_x + (I_y - I_z)θ̇ψ̇]/I_x
θ̈ = [τ_y + (I_z - I_x)φ̇ψ̇]/I_y  
ψ̈ = [τ_z + (I_x - I_y)φ̇θ̇]/I_z

其中：

• φ,θ,ψ 分别为滚转、俯仰、偏航角
• I_x,I_y,I_z 为转动惯量
• τ_x,τ_y,τ_z 为控制力矩

注意：当俯仰角θ接近±90°时会出现万向节锁问题，实际飞行需限制最大倾角

2.3 Simulink建模技巧

在搭建Simulink模型时，我总结出几个关键点：

1. 惯性参数归一化：将转动惯量表示为I_x=1, I_y=1.2, I_z=0.8等相对值，便于不同机型复用
2. 使用MATLAB Function模块实现非线性耦合项
3. 添加饱和限制模块模拟实际电机力矩限制

3. ADRC控制器设计与实现

3.1 一阶ADRC结构分解

以滚转通道为例，ADRC包含三个核心组件：

1. 跟踪微分器(TD)：

   matlab复制function [v1,v2] = TD(v0,h,T)
       persistent x1 x2
       if isempty(x1)