第三章：导弹动力学模型——气动力与力矩、推力模型、重力模型、六自由度刚体运动方程
各位同学，欢迎来到导弹制导与控制的核心地带。
说实话，动力学模型是整个制导控制系统的“身体”。你算法再漂亮，如果身体描述不准，导弹飞起来就是“灵魂出窍”。我个人习惯，在开始任何控制律设计之前，先把这具“身体”摸透。今天我们就来拆解它。
3.1 气动力与力矩：导弹的“手感”
导弹在空中飞，靠的是空气。气动力决定了导弹能不能转弯，能转多快。
3.1.1 气动力的组成
气动力通常分解到三个轴上：
- 阻力 D：与速度方向相反，说白了就是“刹车力”。
- 升力 L：垂直于速度方向，是导弹转弯的主要来源。
- 侧力 Y：横向力，通常由侧滑角引起。
它们的表达式长这样：
D = 0.5 * ρ * V² * S * CD
L = 0.5 * ρ * V² * S * CL
Y = 0.5 * ρ * V² * S * CY其中 ρ 是大气密度，V 是速度，S 是参考面积。CD、CL、CY 是气动系数。
我的经验： 气动系数 CD、CL 通常不是常数。它们随攻角 α 和侧滑角 β 变化。我在项目中遇到过，直接用常系数仿真，结果跟试飞数据差了30%。后来老老实实查了风洞数据表，才把模型校准过来。
3.1.2 气动力矩：让导弹“转起来”
有了力，还得有力矩才能让导弹姿态变化。力矩包括：
- 滚转力矩 L：绕速度轴的转动，由副翼或差动舵控制。
- 俯仰力矩 M：绕横向轴的转动，由升降舵控制。
- 偏航力矩 N：绕垂直轴的转动，由方向舵控制。
力矩公式：
L = 0.5 * ρ * V² * S * b * Cl
M = 0.5 * ρ * V² * S * c * Cm
N = 0.5 * ρ * V² * S * b * Cnb 是翼展，c 是平均气动弦长。Cl、Cm、Cn 是力矩系数。
注意： 力矩系数中有一项叫“动导数”，比如 Cm_q（俯仰阻尼导数）。我曾经忽略它，结果仿真中导弹姿态震荡发散，还以为控制器设计错了。后来加上阻尼项，系统才稳定下来。千万别小看这些“小项”。
3.2 推力模型：发动机的“脾气”
推力是导弹的动力源。不同类型的发动机，推力特性完全不同。
3.2.1 固体火箭发动机
固体火箭发动机推力随时间变化，典型曲线是“先升后降”。
T(t) = T_max * f(t)f(t) 是推力系数，通常由药柱燃烧面积决定。
3.2.2 冲压发动机
冲压发动机的推力与飞行速度、高度有关。速度越快，推力越大，但高空空气稀薄，推力会下降。
关键点： 推力模型不能简单用常数。我建议至少用插值表，把推力写成马赫数和高度的函数。否则，你设计的制导律在低空好用，到了高空就“有气无力”。
3.3 重力模型：逃不掉的“地心引力”
重力是导弹始终要对抗的力。虽然简单，但处理不好会出大问题。
重力加速度 g 随高度变化：
g(h) = g0 * (R / (R + h))²其中 g0 = 9.81 m/s²，R 是地球半径，h 是高度。
在弹道坐标系中，重力分量需要投影到三个轴上：
- 纵向：-g * sin(θ)
- 法向：-g * cos(θ)
θ 是弹道倾角。
避坑指南： 我曾经在仿真中直接用常数 g=9.81，结果高空弹道计算偏差很大。对于射程超过100公里的导弹，高度变化引起的 g 变化不可忽略。建议用上面的公式实时计算。
3.4 六自由度刚体运动方程：导弹的“灵魂”
好了，前面都是零件。现在我们把它们组装起来，形成完整的六自由度（6-DOF）运动方程。
3.4.1 力方程（质心运动）
在弹体坐标系下，三个方向的力平衡：
m * (du/dt + q*w - r*v) = X + T_x + G_x
m * (dv/dt + r*u - p*w) = Y + T_y + G_y
m * (dw/dt + p*v - q*u) = Z + T_z + G_z其中 u、v、w 是速度分量，p、q、r 是角速度。X、Y、Z 是气动力，T 是推力，G 是重力。
3.4.2 力矩方程（姿态运动）
Ixx * dp/dt + (Izz - Iyy) * q * r = L + L_T
Iyy * dq/dt + (Ixx - Izz) * p * r = M + M_T
Izz * dr/dt + (Iyy - Ixx) * p * q = N + N_TIxx、Iyy、Izz 是转动惯量。L、M、N 是气动力矩，L_T、M_T、N_T 是推力偏心引起的力矩。
3.4.3 运动学方程（位置与姿态）
位置更新：
dx/dt = u * cos(θ) * cos(ψ) + v * (sin(φ)*sin(θ)*cos(ψ) - cos(φ)*sin(ψ)) + w * (cos(φ)*sin(θ)*cos(ψ) + sin(φ)*sin(ψ))
dy/dt = u * sin(θ) + v * cos(θ)*cos(φ) - w * cos(θ)*sin(φ)
dz/dt = -u * cos(θ)*sin(ψ) + v * (sin(φ)*sin(θ)*sin(ψ) + cos(φ)*cos(ψ)) + w * (cos(φ)*sin(θ)*sin(ψ) - sin(φ)*cos(ψ))姿态角更新：
dφ/dt = p + (q * sin(φ) + r * cos(φ)) * tan(θ)
dθ/dt = q * cos(φ) - r * sin(φ)
dψ/dt = (q * sin(φ) + r * cos(φ)) / cos(θ)
核心思想： 六自由度方程就是牛顿第二定律在旋转坐标系下的应用。你想想看，导弹一边平动一边转动，所有力、力矩、惯性耦合都要考虑进去。这就是为什么它看起来这么复杂。
3.5 知识体系框架图
下面我用一张 SVG 图来总结本章的知识结构，方便你建立整体认知：
3.6 实战中的注意事项
最后，我分享几个实战中的坑：
- 气动数据要插值：不要用常数，用查表法。我习惯用三次样条插值，平滑且准确。
- 推力偏心不可忽略：发动机安装偏差会产生额外力矩。我曾经在仿真中忽略它，结果实际飞行中导弹滚转失控。
- 重力补偿要到位：在制导律中，重力是已知扰动，必须前馈补偿。否则稳态误差永远消不掉。
- 数值积分要小心：六自由度方程是刚性的，建议用四阶龙格-库塔法，步长不超过0.001秒。
最后提醒： 动力学模型是制导控制的基础。模型不准，后面的一切都是空中楼阁。我建议你花至少40%的时间在建模和验证上，剩下的60%才是控制律设计。别问我怎么知道的——都是血泪教训。
公众号:蓝海资料掘金营，微信deep3321