四旋翼无人机PID与LQR控制算法详解

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

四旋翼无人机作为典型的欠驱动系统，其控制问题一直是自动控制领域的经典案例。这类飞行器具有六个自由度（空间位置x/y/z和姿态角roll/pitch/yaw），却只有四个独立控制输入（四个电机的转速），这种特性使得控制算法设计极具挑战性。

在工程实践中，PID（比例-积分-微分）和LQR（线性二次调节器）是两种最常用的控制策略。PID控制器因其结构简单、参数物理意义明确，成为工业界应用最广泛的算法。而LQR作为最优控制理论的典型代表，能够系统性地处理多变量耦合问题，特别适合四旋翼这种多输入多输出系统。

实际工程中常见误区：许多初学者会直接套用单变量PID参数调节经验来处理四旋翼控制，往往导致系统振荡甚至失稳。必须认识到四旋翼的六个自由度之间存在强耦合关系。

2. PID控制在四旋翼中的应用

2.1 基本PID控制结构

四旋翼通常采用串级PID控制架构：

code复制位置环PID → 姿态环PID → 角速率环PID → 电机混控

这种分层设计将复杂的六自由度控制问题分解为多个单变量控制问题。外环（位置环）的输出作为内环（姿态环）的设定值，逐级传递控制指令。

典型参数范围经验值：

• 位置环：Kp=0.8~1.5, Ki=0.001~0.01, Kd=0.1~0.3
• 姿态环：Kp=3~8, Ki=0, Kd=0.5~2
• 角速率环：Kp=80~150, Ki=0, Kd=5~20

2.2 Simulink实现要点

在Simulink中构建PID控制器时，推荐使用"PID Controller"模块而非自行搭建，因为：

1. 内置抗饱和机制（anti-windup）
2. 支持多种离散化方法（前向/后向差分等）
3. 提供参数自动整定工具

关键配置步骤：

matlab复制% 创建离散PID控制器示例
Kp = 1.2; Ki = 0.05; Kd = 0.2;
Ts = 0.01; % 采样时间10ms
pidObj = pid(Kp,Ki,Kd,'Ts',Ts,...
    'IFormula','Trapezoidal',...
    'DFormula','BackwardEuler');

3. LQR控制设计与实现

3.1 系