4. 固定翼飞机运动方程
固定翼飞行控制律设计的物理基础，是建立能够准确描述飞机空间运动的数学模型。飞机在空中的运动本质上是六自由度（6-DOF）刚体运动——三个质心平移自由度（沿机体轴X、Y、Z的线运动）与三个绕质心转动自由度（滚转、俯仰、偏航角运动）。本章从牛顿-欧拉方程出发，系统推导六自由度刚体动力学方程、运动学方程以及力和力矩方程，并给出工程中常用的简化假设与使用边界。理解这些方程的物理含义与推导脉络，是后续进行线性化、配平、控制律设计与仿真验证的前提。
上图展示了固定翼六自由度运动方程的整体框架：左侧为机体轴系、地面轴系与外力/力矩来源，中央为三大核心方程，右侧为对应的状态变量。下面我们逐一展开推导与工程解读。
4.1 六自由度刚体动力学方程：力方程与力矩方程
核心原理：刚体动力学方程描述的是力与加速度、力矩与角加速度之间的关系。在机体轴系下，由于坐标系固连于飞机且随飞机转动，牛顿第二定律需要加入由于坐标系旋转而产生的附加项——科氏力与陀螺力矩。
设飞机质量为 m，质心速度为 V = [u, v, w]T（沿机体轴Xb、Yb、Zb的分量），角速度为 ω = [p, q, r]T（滚转、俯仰、偏航角速度），外力合力为 F = [Fx, Fy, Fz]T，则力方程在机体轴系下表示为：
m(du/dt + q·w - r·v) = F_x
m(dv/dt + r·u - p·w) = F_y
m(dw/dt + p·v - q·u) = F_z其中 q·w - r·v、r·u - p·w、p·v - q·u 即为科氏加速度项，来源于机体坐标系自身的旋转。若忽略这些项，在高速机动或大角速度飞行时会产生显著误差。
对于力矩方程，设飞机关于质心的惯性张量为 I，在机体轴系下通常表示为：
I = [I_x, -I_xy, -I_xz;
-I_xy, I_y, -I_yz;
-I_xz, -I_yz, I_z]由于固定翼飞机通常具有纵向对称面（XbOZb平面），因此 Ixy = Iyz = 0，但 Ixz 一般不为零。力矩方程为：
I_x·dp/dt - I_xz·(dr/dt + p·q) + (I_z - I_y)·q·r = L
I_y·dq/dt + I_xz·(p² - r²) + (I_x - I_z)·p·r = M
I_z·dr/dt - I_xz·dp/dt + (I_y - I_x)·p·q = N其中 L、M、N 分别为滚转、俯仰、偏航气动力矩（含推力力矩）。
4.2 运动学方程：位置与姿态的更新
核心原理：运动学方程描述的是位置和姿态随时间的变化率，不涉及力与质量，纯粹是几何关系。位置方程将机体速度转换到地面轴系：
[dx_g/dt] [cosθ·cosψ, sinφ·sinθ·cosψ - cosφ·sinψ, cosφ·sinθ·cosψ + sinφ·sinψ] [u]
[dy_g/dt] = [cosθ·sinψ, sinφ·sinθ·sinψ + cosφ·cosψ, cosφ·sinθ·sinψ - sinφ·cosψ] [v]
[dz_g/dt] [-sinθ, sinφ·cosθ, cosφ·cosθ] [w]姿态运动学方程描述欧拉角速率与机体角速度的关系：
dφ/dt = p + q·sinφ·tanθ + r·cosφ·tanθ
dθ/dt = q·cosφ - r·sinφ
dψ/dt = (q·sinφ + r·cosφ) / cosθ注意当 θ 接近 ±90° 时，tanθ 和 1/cosθ 趋于无穷，即欧拉角奇异点问题。工程上若飞机可能进入大俯仰角状态，需改用四元数法表示姿态。
| 表示方法 | 优点 | 缺点 | 适用场景 |
|---|---|---|---|
| 欧拉角 | 物理意义直观，便于控制律设计 | 存在奇异点（θ=±90°） | 常规飞行包线内 |
| 四元数 | 无奇异点，计算效率高 | 物理意义不直观 | 全姿态飞行、仿真验证 |
| 方向余弦矩阵 | 数值稳定 | 9个参数冗余，计算量大 | 惯性导航系统 |
4.3 力和力矩方程：气动力与推力的建模
核心原理：力与力矩方程是连接空气动力学与控制输入的桥梁。气动力和力矩通常以无量纲系数的形式给出，依赖于飞行状态（迎角α、侧滑角β、马赫数Ma、动压q̄）和控制面偏度（升降舵δe、副翼δa、方向舵δr）。
气动力在风轴系中通常分解为升力 L、阻力 D 和侧力 Y，再转换到机体轴系。气动力矩则直接以机体轴系给出：
L = q̄·S·b·(C_l0 + C_lβ·β + C_lp·p·b/(2V) + C_lr·r·b/(2V) + C_lδa·δa + C_lδr·δr)
M = q̄·S·c̄·(C_m0 + C_mα·α + C_mq·q·c̄/(2V) + C_mδe·δe)
N = q̄·S·b·(C_n0 + C_nβ·β + C_np·p·b/(2V) + C_nr·r·b/(2V) + C_nδa·δa + C_nδr·δr)其中 S 为机翼参考面积，b 为翼展，c̄ 为平均气动弦长，V 为空速，q̄ = ½ρV² 为动压。推力模型通常简化为沿机体轴Xb方向的力 T，并可能产生俯仰力矩 T·zT（推力线到质心的垂直距离）。
4.4 案例拆解：某小型无人机纵向动力学建模
案例背景：某翼展2.4m、起飞重量5kg的小型固定翼无人机，需设计俯仰姿态保持控制律。首先需要建立纵向动力学模型。
关键参数：
- 质量 m = 5kg，Iy = 0.12 kg·m²
- 机翼面积 S = 0.45 m²，平均气动弦长 c̄ = 0.25 m
- 巡航速度 V = 18 m/s，海平面大气密度 ρ = 1.225 kg/m³
- 气动导数：Cmα = -0.45 /rad，Cmδe = -0.65 /rad，CLα = 4.8 /rad，CD0 = 0.03
建模过程：首先计算动压 q̄ = ½ × 1.225 × 18² = 198.45 Pa。纵向力方程（简化为对称飞行，v = p = r = 0）：
m(dw/dt - q·u) = Z (机体轴Z向气动力)
I_y·dq/dt = M (俯仰力矩)将气动力系数转换到机体轴，并加入重力分量。在配平状态（α = 2°，δe = -1.5°）附近线性化，得到状态方程：
dx/dt = A·x + B·δe
x = [Δu, Δw, Δq, Δθ]ᵀ其中 A 矩阵的特征值分析显示：短周期模态阻尼比 ζsp = 0.38，自然频率 ωsp = 8.2 rad/s；长周期模态阻尼比 ζph = 0.05，自然频率 ωph = 0.9 rad/s。短周期阻尼偏低，需要增加俯仰阻尼增益。
结果与复盘：基于该模型设计的PD控制器（俯仰角反馈+俯仰角速率反馈）成功将短周期阻尼提升至0.7。建模中最大的误差来源是 Cmα 的估算偏差（约±10%），导致自然频率误差约5%，在可接受范围内。经验教训：对于小型无人机，螺旋桨滑流对 Cmδe 的影响不可忽略，需在风洞或飞行数据中修正。
4.5 常见误区与总结复盘
- 坐标系混淆：将地面轴系的速度分量直接代入机体轴系方程，导致科氏项错误。解决方法是始终明确标注坐标系，并在转换矩阵处设置检查点。
- 忽略惯性积 Ixz：对于常规布局，Ixz 虽小但会导致滚转-偏航耦合。若忽略，荷兰滚模态的阻尼比估算可能偏差30%以上。
- 欧拉角奇异点：当俯仰角接近90°时，姿态运动学方程数值发散。若飞行包线包含大俯仰角，必须改用四元数。
- 气动导数单位错误：角速度导数（如 Cmq）通常以无量纲形式给出，需乘以 c̄/(2V) 才能使用。单位混淆会导致力矩计算偏差一个数量级。
- 推力力矩被忽略：对于推力线高于质心的飞机（如高翼布局），推力产生的俯仰力矩在低速大推力状态不可忽略。
总结：六自由度运动方程是飞行控制律设计的基石。力方程和力矩方程描述了飞机的动力学特性，运动学方程描述了飞机的几何运动关系，而力和力矩方程则建立了气动数据与控制输入的接口。在实际工程中，建议按照以下流程操作：
- 明确坐标系定义与转换关系，绘制坐标系示意图。
- 收集飞机质量、惯性矩、气动导数等参数，建立参数表。
- 根据任务需求选择方程形式（全量/线性化、欧拉角/四元数）。
- 在仿真环境中验证模型，对比飞行数据或风洞数据。
- 进行灵敏度分析，识别关键参数（如 Cmα、Iy）对控制律设计的影响。
掌握本章内容后，读者应能独立推导任意固定翼飞机的六自由度方程，并能够识别建模中的关键假设与潜在误差源。这是后续进行控制律设计、仿真验证和飞行测试的必备基础。