四旋翼无人机控制仿真：PID与LQR对比实践

1. 四旋翼无人机控制仿真概述

四旋翼无人机作为一种典型的欠驱动系统，其动力学模型具有强耦合、非线性的特点。在MATLAB/Simulink环境下搭建完整的控制仿真系统，需要解决建模、控制器设计、参数整定三大核心问题。本次分享的仿真项目包含两个SLX模型文件（分别对应PID和LQR控制方案）和一个M脚本文件（用于参数初始化与结果分析），这种架构设计既保证了模块化开发的优势，又能实现控制算法的快速对比验证。

从工程实践角度看，完整的仿真系统应当包含以下要素：

• 精确的六自由度动力学模型（含机体坐标系与惯性坐标系的转换）
• 传感器噪声与执行器延迟的模拟
• 可配置的环境扰动模块（风场模型等）
• 多速率采样系统（通常控制器运行在100-200Hz，而状态估计可能在50Hz）

提示：在Simulink中搭建此类系统时，建议采用"模块化分层"设计思想，将plant model、controller、environment等核心组件封装为独立子系统，通过总线信号传递数据。这种结构既便于调试，也符合实际飞控软件的架构逻辑。

2. 动力学建模关键实现

2.1 坐标系定义与转换

在Quadcopter_Model.slx中，我们采用标准的North-East-Down（NED）地面坐标系和机体坐标系（X轴向前，Y轴向右，Z轴向下）。坐标系转换通过方向余弦矩阵实现：

matlab复制% 在Init.m中定义的旋转矩阵计算函数
function R = rotationMatrix(phi, theta, psi)
    R_x = [1 0 0; 0 cos(phi) sin(phi); 0 -sin(phi) cos(phi)];
    R_y = [cos(theta) 0 -sin(theta); 0 1 0; sin(theta) 0 cos(theta)];
    R_z = [cos(psi) sin(psi) 0; -sin(psi) cos(psi) 0; 0 0 1];
    R = R_z * R_y * R_x; % Z-Y-X旋转顺序
end

2.2 非线性动力学方程

四旋翼的六自由度运动方程可表示为：

code复制m·a = ΣF - m·g·z
I·α + ω×(I·ω) = ΣM