四旋翼无人机控制算法：PID与ADRC对比与实践

1. 四旋翼无人机控制算法概述

四旋翼无人机作为一种典型的欠驱动系统，其控制算法的选择直接影响飞行性能和稳定性。在工程实践中，PID控制和ADRC控制是两种最常用的控制策略。作为一名从事飞行控制系统开发多年的工程师，我经常需要根据具体应用场景来选择合适的控制算法。

四旋翼无人机具有6个自由度（位置x,y,z和姿态角φ,θ,ψ），但只有4个控制输入（四个旋翼的转速），这种特性使得其控制问题具有挑战性。传统PID控制器因其结构简单、易于实现等优点被广泛采用，但在面对复杂扰动和模型不确定性时表现欠佳。而ADRC（自抗扰控制）通过主动估计和补偿系统内外扰动，展现出更强的鲁棒性。

2. 动力学模型建立

2.1 基本假设与坐标系定义

在建立四旋翼动力学模型前，我们需要明确几个基本假设：

1. 无人机为刚性对称体
2. 重心与几何中心重合
3. 地面效应和旋翼间气动干扰可忽略

采用北东地（NED）坐标系作为惯性系，机体坐标系遵循右手定则，X轴向前，Y轴向右，Z轴向下。通过欧拉角（φ,θ,ψ）描述机体姿态。

2.2 完整动力学方程推导

基于牛顿-欧拉方程，四旋翼的六自由度动力学模型可表示为：

位置动力学：

code复制mẍ = (sinψ sinφ + cosψ sinθ cosφ)U₁
mÿ = (-cosψ sinφ + sinψ sinθ cosφ)U₁
mz̈ = mg - (cosθ cosφ)U₁

姿态动力学：

code复制Iₓφ̈ = θ̇ψ̇(I_y - I_z) + l(U₂ - U₄)
I_yθ̈ = φ̇ψ̇(I_z - Iₓ) + l(U₃ - U₁)
I_zψ̈ = φ̇θ̇(Iₓ - I_y) + (U₁ - U₂ + U₃ - U₄)

其中控制输入U₁～U₄与旋翼转速ω₁～ω₄的关系为：

code复制U₁ = b(ω₁² + ω₂² + ω₃² + ω₄²)
U₂ = b(ω₂² - ω₄²) 
U₃ = b(ω₃² - ω₁²)
U₄ = d(-ω₁² + ω₂² - ω₃² + ω₄²)

注意：实际建模时需要考虑电机动力学延迟，通常用一阶惯性环节近似表示电机响应特性。

3. PID控制器设计与实现

3.1 串级PID控制结构

针对四旋翼的强耦合特性，我们采用串级