四旋翼无人机动力学建模与现代控制方法实践

1. 四旋翼无人机控制理论概述

四旋翼无人机作为典型的欠驱动系统，其动力学特性一直是控制理论研究的经典案例。这类飞行器仅通过四个旋翼的转速差实现六自由度的空间运动，这种强耦合、非线性的特性使得传统PID控制难以满足高性能飞行需求。在实际工程中，我们常采用ADRC（自抗扰控制）、SMC（滑模控制）和MPC（模型预测控制）等现代控制方法来解决这一难题。

刚体动力学建模是控制算法设计的基础。完整的四旋翼模型需要考虑机体坐标系与惯性坐标系间的欧拉角转换、电机动力学特性、陀螺效应以及外部扰动等因素。通过建立准确的数学模型，我们才能在Simulink中搭建高保真度的仿真环境，这对控制算法的验证至关重要。

提示：四旋翼的欠驱动特性体现在它只有4个控制输入（四个电机转速），却需要控制6个自由度（x,y,z位置和滚转、俯仰、偏航角），这种输入输出不匹配是控制设计的主要挑战。

2. 刚体动力学建模核心原理

2.1 坐标系定义与转换

四旋翼建模需要定义两个关键坐标系：

• 惯性坐标系（世界坐标系）：固定于地面，遵循右手定则，Z轴垂直向上
• 机体坐标系：固连在无人机重心，X轴指向机头方向

两者间的转换通过Z-Y-X欧拉角（偏航ψ、俯仰θ、滚转φ）完成。旋转矩阵R的计算公式为：

matlab复制% MATLAB代码示例：欧拉角转旋转矩阵
function R = euler2rot(phi, theta, psi)
    Rz = [cos(psi) -sin(psi) 0; sin(psi) cos(psi) 0; 0 0 1];
    Ry = [cos(theta) 0 sin(theta); 0 1 0; -sin(theta) 0 cos(theta)];
    Rx = [1 0 0; 0 cos(phi) -sin(phi); 0 sin(phi) cos(phi)];
    R = Rz * Ry * Rx;
end

2.2 牛顿-欧拉方程推导

基于刚体动力学，我们分别建立平移和旋转运动方程：

平移动力学：
m·a = F_gravity + F_thrust + F_drag
其中推力F_thrust = k_f·Σω_i²，k_f为推力系数，ω_i为各电机转速

旋转动力学：