四旋翼无人机Simulink建模与控制算法实现

1. 四旋翼无人机Simulink建模概述

四旋翼无人机作为一种典型的欠驱动系统，其建模与仿真一直是控制领域的热点研究方向。在Simulink环境下搭建完整的无人机模型，能够有效验证控制算法的性能，大幅降低实物测试的成本和风险。

我最近完成了一个完整的四旋翼建模项目，从最基础的运动学方程开始，逐步构建了六自由度动力学模型，最终实现了基于PD控制的位置跟踪。这个过程中遇到了不少有意思的问题，比如坐标系转换时的符号错误导致无人机"鬼畜飞行"，PID参数整定时的发散振荡，以及Simulink求解器选择不当导致的仿真卡死等等。

2. 坐标系定义与运动学建模

2.1 坐标系系统建立

四旋翼建模首先需要明确三个关键坐标系：

1. 地面惯性坐标系（O-XYZ）：固定于地面，Z轴垂直向上
2. 机体坐标系（o-xyz）：固连于无人机质心，x轴指向机头方向
3. 旋翼坐标系：每个电机桨叶的旋转平面

在Simulink中，我使用Bus Creator模块将这些坐标系参数打包处理，方便后续模块调用。一个常见的错误是混淆坐标系转换顺序，我最初就因先转偏航后转俯仰，导致无人机姿态计算完全错误。

2.2 欧拉角与旋转矩阵

通过Z-Y-X顺序的欧拉角变换，建立从机体坐标系到地面坐标系的方向余弦矩阵：

matlab复制R = [cosθ*cosψ, sinφ*sinθ*cosψ-cosφ*sinψ, cosφ*sinθ*cosψ+sinφ*sinψ;
     cosθ*sinψ, sinφ*sinθ*sinψ+cosφ*cosψ, cosφ*sinθ*sinψ-sinφ*cosψ;
     -sinθ,     sinφ*cosθ,                  cosφ*cosθ];

在Simulink中实现时，我建议使用Fcn模块而非直接搭建矩阵乘法，这样可读性更好。记得添加角度限幅器，防止万向节锁现象。

3. 六自由度动力学模型构建

3.1 平移动力学

根据牛顿第二定律建立质心运动方程：

code复制m·a = ΣF_ext
= mg·z + R·[0;0;T] 

其中T为总升力，在Simulink中用Sum模块汇总四个电机的拉力。我最初忽略了地面坐标系下的重力分量方向，导致无人机在仿真中"飘"向