1. 多旋翼飞行器动力学建模基础
多旋翼飞行器的动力学建模是控制系统设计的前提和基础。要准确描述飞行器的运动状态，我们需要建立完整的六自由度数学模型。这个模型需要包含平移运动和旋转运动两个部分，同时考虑外部环境因素的影响。
1.1 坐标系定义与转换
在建模过程中，我们通常使用两个主要坐标系：地面惯性坐标系（NED坐标系）和机体坐标系。地面惯性坐标系固定在地面上，X轴指向正北，Y轴指向正东，Z轴垂直向下指向地心。机体坐标系则固定在飞行器上，X轴指向机头方向，Y轴指向右侧，Z轴垂直向下。
两个坐标系之间的转换通过旋转矩阵实现。欧拉角（滚转角φ、俯仰角θ、偏航角ψ）描述了机体坐标系相对于地面惯性坐标系的姿态。旋转矩阵R可以表示为：
code复制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θ]
注意：在使用欧拉角表示姿态时，需要注意万向节锁问题。当俯仰角θ=±90°时，滚转角φ和偏航角ψ会失去一个自由度。
1.2 平移运动方程
多旋翼飞行器的平移运动可以用牛顿第二定律描述。在地面惯性坐标系中，飞行器的运动方程为：
code复制m * d²x/dt² = R * [0; 0; T] - [0; 0; mg] - F_drag
其中：
- m是飞行器总质量
- x=[x y z]'是位置向量
- T是总升力（所有旋翼产生的垂直升力之和）
- F_drag是空气阻力，通常建模为与速度平方成正比
1.3 旋转运动方程
旋转运动由欧拉方程描述：
code复制I * dω/dt + ω × (I * ω) = M
其中：
- I是惯性矩阵
- ω=[p q r]'是角速度向量（机体坐标系下）
- M=[Mx My Mz]'是总力矩
对于对称设计的四旋翼，惯性矩阵通常近似为对角矩阵：
code复制I = [Ixx 0 0;
0 Iyy 0;
0 0 Izz]