第三章 导弹动力学模型：刚体运动方程、气动力与力矩、推力模型、重力模型
各位同学，大家好。今天我们进入导弹飞控最核心的环节——动力学建模。说白了，就是把导弹在空中怎么飞、怎么转，用数学语言描述出来。我做了十几年飞控，见过太多因为模型建得不够准，导致仿真跑得挺好看，一上靶场就出问题的案例。所以这一章，咱们得把底子打扎实。
3.1 刚体运动方程：六自由度的“骨架”
导弹在空中飞行，可以看作一个刚体。刚体运动，说白了就是两个事：质心怎么移动，以及绕质心怎么转动。这就是我们常说的六自由度（6-DOF）模型。
质心移动方程（力方程）
我习惯用机体坐标系来写。导弹受到的合外力，包括气动力、推力、重力。根据牛顿第二定律：
m * (dV/dt + ω × V) = F_aero + F_thrust + F_gravity这里V是速度矢量，ω是角速度矢量。那个叉乘项ω×V，是哥氏加速度项。嗯，这里要注意，很多新手容易漏掉这一项，仿真出来的轨迹会偏。
绕质心转动方程（力矩方程）
转动方程描述导弹怎么转。根据动量矩定理：
I * dω/dt + ω × (I * ω) = M_aero + M_thrustI是惯性张量矩阵。为什么会有ω×(I·ω)这一项？因为导弹在转的时候，惯性主轴和机体轴不重合，会产生耦合效应。我在做某型空空导弹时，就因为忽略了这一项，导致滚转通道和偏航通道出现了奇怪的耦合振荡，查了三天才找到原因。
核心要点：六自由度方程是飞控仿真的“骨架”。力方程管速度变化，力矩方程管姿态变化。两者通过姿态角（欧拉角或四元数）耦合在一起。
3.2 气动力与力矩：导弹的“手感”
气动力是导弹飞行中最重要的外力。它决定了导弹的机动能力、稳定性，说白了就是导弹的“手感”。
气动力的组成
气动力通常分解为三个分量：
- 升力（Lift）：垂直于速度方向，提供机动过载
- 阻力（Drag）：平行于速度方向，阻碍前进
- 侧力（Side Force）：垂直于对称面，由侧滑引起
它们的表达式通常写成：
L = 0.5 * ρ * V² * S * CL(α, β, Ma, δ)
D = 0.5 * ρ * V² * S * CD(α, β, Ma, δ)
Y = 0.5 * ρ * V² * S * CY(α, β, Ma, δ)ρ是大气密度，V是空速，S是参考面积。CL、CD、CY是气动系数，通常通过风洞实验或CFD计算得到。它们都是攻角α、侧滑角β、马赫数Ma、舵偏角δ的函数。
气动力矩
力矩同样有三个分量：滚转力矩L、俯仰力矩M、偏航力矩N。表达式类似：
L = 0.5 * ρ * V² * S * b * Cl(α, β, Ma, δ)
M = 0.5 * ρ * V² * S * c * Cm(α, β, Ma, δ)
N = 0.5 * ρ * V² * S * b * Cn(α, β, Ma, δ)b是翼展，c是平均气动弦长。Cl、Cm、Cn是力矩系数。
个人经验：气动数据是导弹建模中最头疼的部分。我曾经遇到过一个项目，风洞数据和CFD数据在跨音速区差了20%以上。最后我们不得不做了两次飞行试验来校准。所以，拿到气动数据后，一定要先做交叉验证，别急着往模型里塞。
3.3 推力模型：发动机的“脾气”
推力是导弹的动力来源。不同类型的发动机，推力特性差别很大。
固体火箭发动机
固体火箭发动机的推力随时间变化，典型曲线是“先升后降”。我习惯用分段函数来拟合：
F_thrust(t) =
F_max * (t / t_burn) , 0 ≤ t < t_burn
F_max * (1 - (t-t_burn)/t_tail), t_burn ≤ t < t_burn + t_tail
0 , t ≥ t_burn + t_tailF_max是最大推力，t_burn是燃烧时间，t_tail是拖尾时间。当然，实际发动机的推力曲线更复杂，但工程上这个模型够用了。
推力偏心
这里要特别提一下推力偏心。发动机安装不可能绝对对中，会产生一个额外的力矩。这个力矩虽然不大，但在高精度制导中必须考虑。我曾经做过一个仿真，加了0.1度的推力偏心，脱靶量从0.5米变成了3米。你想想看，这个影响有多大。
避坑指南：推力模型不要只给一个恒定值。发动机工作过程中，质心位置也在变化（燃料消耗），这会改变惯性张量I。我见过有人用恒定质心做仿真，结果和实际飞行差了十万八千里。
3.4 重力模型：最“老实”的力
重力是所有力中最简单的，但也是最容易被忽视的。为什么这么说？因为重力虽然表达式简单，但它的方向一直在变。
重力表达式
在地球表面附近，重力加速度g ≈ 9.81 m/s²。重力矢量在导航坐标系（通常是北东地坐标系）中表示为：
G_nav = [0, 0, m * g]^T注意，这里用的是“北东地”坐标系，重力沿Z轴正方向（向下）。
坐标变换
重力在机体坐标系中的分量，需要通过姿态矩阵变换得到：
G_body = C_nav_to_body * G_navC_nav_to_body是导航系到机体系的旋转矩阵，由欧拉角（滚转φ、俯仰θ、偏航ψ）决定。具体展开后：
G_body_x = -m * g * sin(θ)
G_body_y = m * g * cos(θ) * sin(φ)
G_body_z = m * g * cos(θ) * cos(φ)你看，重力在机体轴上的分量，和俯仰角、滚转角直接相关。这就是为什么导弹在做大机动时，重力补偿必须做准。
关键点：重力模型虽然简单，但坐标变换不能出错。我建议在代码里单独写一个重力计算函数，每次调用前先检查姿态角是否更新。我曾经因为姿态更新和重力计算顺序搞反了，导致仿真结果出现了“反重力”现象——导弹居然往上飘了。
3.5 知识体系总览
为了让大家更直观地理解这一章的知识结构，我画了一张图。这张图展示了导弹动力学模型的四个核心模块，以及它们之间的数据流关系。
这张图把四个模块串起来了。刚体运动方程是核心骨架，气动力、推力、重力是输入。输出的是导弹的位置、速度、姿态、角速度。这些状态量又会反馈到气动力和推力计算中（比如攻角、马赫数），形成闭环。
我的建议：刚开始学建模的同学，可以先从“力方程+重力”开始，把平动部分跑通。然后再加入力矩方程，最后再细化气动模型。一步一步来，别想一口吃成胖子。
好了，这一章的内容就到这里。导弹动力学模型是飞控系统的基础，模型建得准不准，直接决定了控制律设计的好坏。下一章我们会讲控制律设计，到时候你会发现，今天学的这些模型，每一个都会用到。
公众号:蓝海资料掘金营，微信deep3321