MATLAB四旋翼PID仿真与Simulink建模实战

1. 为什么选择MATLAB做四旋翼PID仿真？

四旋翼飞行器的控制算法开发过程中，PID控制器因其结构简单、参数物理意义明确，成为工程实践中的首选方案。而MATLAB/Simulink环境为这类控制系统的快速原型验证提供了得天独厚的条件：

仿真环境的核心优势：

• 多物理域建模能力：Simulink支持机械系统（通过Simscape）、空气动力学（通过Aerospace Blockset）与控制算法的联合仿真，这是其他编程语言难以比拟的
• 实时参数调优：在仿真运行过程中，可直接拖拽PID模块的滑钮调整P/I/D参数，即时观察响应曲线变化
• 自动化代码生成：完成仿真验证后，可通过Embedded Coder直接生成C代码部署到真实飞控硬件（如Pixhawk）

提示：2023年发布的MATLAB R2023a版本对Simulink PID控制器模块进行了重大升级，新增了抗饱和（anti-windup）和设定值权重（setpoint weighting）等实用功能，建议使用较新版本进行仿真。

2. 四旋翼动力学建模基础

2.1 坐标系定义与姿态描述

建立两个右手坐标系：

• 惯性坐标系（O-XYZ）：固定于地面，Z轴垂直向上
• 机体坐标系（o-xyz）：原点在四旋翼质心，x轴指向机头方向

姿态角采用Z-Y-X欧拉角表示：

• 滚转角φ（Roll）：绕x轴旋转
• 俯仰角θ（Pitch）：绕y轴旋转
• 偏航角ψ（Yaw）：绕z轴旋转

2.2 刚体运动方程

通过牛顿-欧拉方程建立动力学模型：

平移运动：
$$
m \ddot{\mathbf{P}} = m\mathbf{g} + \mathbf{R} \cdot \mathbf{F}_b
$$

旋转运动：
$$
\mathbf{I} \dot{\boldsymbol{\omega}} + \boldsymbol{\omega} \times \mathbf{I} \boldsymbol{\omega} = \boldsymbol{\tau}
$$

其中：

• $m$为四旋翼质量
• $\mathbf{P}=[x,y,z]^T$是位置向量
• $\mathbf{R}$是机体到惯性系的旋转矩阵
• $\mathbf{F}_b$是