四旋翼无人机Matlab建模与仿真技术详解

1. 四旋翼无人机建模与仿真概述

四旋翼无人机作为典型的欠驱动系统，其动力学特性一直是控制领域的研究热点。Matlab凭借其强大的矩阵运算能力和丰富的工具箱，成为实现无人机建模与仿真的理想工具。这套代码实现了从非线性刚体动力学到线性传递函数的完整建模链路，并通过可视化手段直观展示仿真结果。

在实际工程中，完整的无人机仿真通常包含三个关键环节：首先建立精确的非线性动力学模型描述真实飞行特性；然后通过合理的线性化方法得到便于控制器设计的传递函数模型；最后通过可视化验证模型准确性。这套代码的价值在于将这三个环节有机整合，形成闭环验证流程。

2. 非线性刚体动力学建模

2.1 坐标系定义与运动分解

四旋翼的运动分析需要建立两套坐标系：机体坐标系(B系)和地面惯性坐标系(E系)。B系原点位于无人机质心，x轴指向机头方向，z轴垂直向下；E系为固定于地面的东北天坐标系。两者间的转换通过Z-Y-X欧拉角描述，即偏航角ψ、俯仰角θ和滚转角φ。

运动学方程描述位姿变化率与角速度的关系：

code复制φ̇ = p + q sinφ tanθ + r cosφ tanθ
θ̇ = q cosφ - r sinφ  
ψ̇ = (q sinφ + r cosφ)/cosθ

其中p,q,r为机体角速度分量。这个方程揭示了欧拉角变化的非线性特性，特别是当θ接近±90°时会出现奇点。

2.2 牛顿-欧拉方程推导

基于刚体假设，建立平移和旋转动力学方程。平移动力学在E系中描述：

code复制mẍ = [0;0;mg] - R(φ,θ,ψ)[0;0;T]

其中R为旋转矩阵，T为总升力。旋转动力学在B系中描述：

code复制Iω̇ + ω×Iω = τ

I为惯性张量矩阵，τ=[τ_φ; τ_θ; τ_ψ]为控制力矩。这个耦合的非线性方程组完整描述了无人机六自由度运动。

2.3 螺旋桨动力学建模

每个旋翼产生的升力F_i与转速平方成正比：

code复制F_i = k_f ω_i^2

同时产生反扭矩：

code复制Q_i = k_m ω_i^2

总升力和控制力矩计算：

code复制T = ΣF_i
τ_φ = l(F_2 - F_4)
τ_θ = l(F_3 - F_1) 
τ_ψ = ΣQ_i

l为机体中心到旋翼的距离。这个模