四旋翼飞行器动力学建模与PID控制实践

1. 多旋翼飞行器动力学建模与PID控制概述

多旋翼飞行器作为典型的欠驱动系统，其稳定飞行依赖于精确的动力学模型和高效的控制算法。在实际工程中，我们常采用牛顿-欧拉方程建立六自由度运动模型，通过解耦处理将其分解为位置控制和姿态控制两个子系统。以四旋翼为例，其动力学特性主要受四个电机产生的升力和力矩影响，这种特殊的结构使得俯仰、横滚和偏航运动之间存在强耦合关系。

关键提示：建模时需要特别注意机体坐标系与地面坐标系之间的转换关系，以及螺旋桨陀螺效应带来的耦合影响。这是后续控制器设计的基础。

2. 动力学建模核心步骤解析

2.1 坐标系定义与转换

建立合理的坐标系体系是建模的第一步。通常需要定义：

• 地面惯性坐标系（NED坐标系）
• 机体坐标系（与飞行器固连）
• 通过Z-Y-X欧拉角（ψ-θ-φ）描述两者转换关系

旋转矩阵R的计算公式为：

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θ];

2.2 刚体动力学方程推导

基于牛顿第二定律和欧拉方程，建立如下动力学模型：

平动方程：
m·a = R·F - m·g·[0;0;1] - k_d·v

转动方程：
I·ω̇ + ω×(I·ω) = τ - k_r·ω

其中：

• m为飞行器质量
• I为惯性张量矩阵
• k_d和k_r为空气阻力系数
• F和τ分别为总升力和力矩

2.3 执行器建模

四旋翼的升力和力矩与电机转速平方成正比：

code复制F_i = k_f·ω_i²
τ_i = k_m·ω_i²

总控制量可表示为：

code复制[F; τ_x; τ_y; τ_z] = [k_f  k_f   k_f  k_f;
                      0   -lk_f  0    lk_f;
                     -lk_f 0     lk_f 0;