2. 飞行动力学基础：刚体运动方程、坐标系与转换、力和力矩分析

各位同学，大家好。今天我们进入飞控系统最核心的地基——飞行动力学。说白了，就是搞清楚飞机到底是怎么在空中运动的。我常说，不懂动力学，你写的控制律就是空中楼阁。这一章，我们重点啃三块硬骨头：刚体运动方程、坐标系转换、还有力和力矩分析。

2.1 刚体运动方程：六自由度模型

飞机在空中，不是个质点。它有体积，有质量分布。我们把它简化成一个刚体——嗯，就是假设它不会变形。这样一来，它的运动就可以分解成两部分：

• 质心的平动（三个自由度：前后、左右、上下）
• 绕质心的转动（三个自由度：俯仰、滚转、偏航）

合起来，就是经典的六自由度（6-DOF）模型。我个人习惯，把方程写成牛顿-欧拉形式，清晰明了：

平动方程（力方程）：
m * (dV/dt + ω × V) = F_ext

转动方程（力矩方程）：
I * (dω/dt) + ω × (I * ω) = M_ext

这里，V是速度向量，ω是角速度向量，I是惯性张量。注意那个叉乘项 ω × V 和 ω × (I·ω)，这是刚体动力学里最坑人的地方——耦合效应。我在项目中遇到过，有人把这两个叉乘项忽略了，结果仿真出来的飞机像个幽灵一样，完全不符合物理规律。

2.2 坐标系与转换：别搞混了方向

坐标系是飞行动力学的语言。你想想看，如果我说“飞机往北飞”，但你的坐标系里北是负方向，那不就乱套了？常用的坐标系有三个：

坐标系	原点	X轴	Y轴	Z轴
地轴系（NED）	地面某点	北	东	地心（向下）
机体轴系（Body）	飞机重心	机头方向	右翼方向	垂直向下（座舱到地板）
气流轴系（Wind）	飞机重心	来流方向	垂直于X轴向右	垂直于X轴向下

坐标系转换，说白了就是旋转。我们用欧拉角（俯仰θ、滚转φ、偏航ψ）来描述机体相对于地面的姿态。转换矩阵长这样：

从机体到地面的旋转矩阵 R_b2e：
R_b2e = R_z(ψ) * R_y(θ) * R_x(φ)

其中：
R_x(φ) = [[1, 0, 0],
          [0, cosφ, -sinφ],
          [0, sinφ, cosφ]]

R_y(θ) = [[cosθ, 0, sinθ],
          [0, 1, 0],
          [-sinθ, 0, cosθ]]

R_z(ψ) = [[cosψ, -sinψ, 0],
          [sinψ, cosψ, 0],
          [0, 0, 1]]

这里有个坑：旋转顺序是Z-Y-X，也就是先偏航、再俯仰、最后滚转。顺序搞反了，姿态就全错了。我建议你每次写代码时，都把这个顺序注释在矩阵旁边，免得自己忘了。

2.3 力和力矩分析：谁在推着飞机飞？

飞机在空中，受到的外力主要有四种：

• 重力：永远指向地心。在机体轴系下，它随姿态变化而变化。
• 升力：垂直于来流方向，主要由机翼产生。
• 阻力：平行于来流方向，与运动方向相反。
• 推力：发动机产生的，一般沿机体X轴方向。

力矩呢？主要是气动力矩：

• 滚转力矩 L：由副翼差动产生。
• 俯仰力矩 M：由升降舵偏转产生。
• 偏航力矩 N：由方向舵偏转产生。

把这些力和力矩代入六自由度方程，就得到了完整的飞行动力学模型。我画了一张图，帮你理清它们之间的关系：

从这张图你可以看到，控制输入（舵面偏转、油门开度）先经过力和力矩计算模块，然后驱动刚体运动方程，输出飞机的状态。而坐标系转换模块，则负责在不同坐标系之间来回切换——比如把重力从地轴系转到机体轴系。

好了，这一章的内容就到这里。记住，坐标系别搞混，叉乘项别漏掉，力和力矩的来源要清楚。这些都是我当年踩过的坑，现在分享给你们，希望能帮你们少走弯路。

---