第三章 导弹动力学建模：刚体运动方程、气动力与力矩模型、推力模型

各位同学，今天我们来啃一块硬骨头——导弹动力学建模。说实话，很多初学者一看到密密麻麻的方程就头大，觉得这是纯理论推导。但我可以负责任地告诉你：动力学模型是制导系统的“身体”，你设计的控制律再漂亮，如果身体描述不准，一切都是空中楼阁。我在某型号项目中就吃过这个亏，后面会细说。

3.1 刚体运动方程：六自由度的“骨架”

导弹在空中飞行，本质上是一个六自由度刚体运动。哪六个？三个平动自由度（质心位置），三个转动自由度（姿态角）。

我个人习惯把运动方程拆成两部分来看：

• 动力学方程：描述力与加速度、力矩与角加速度的关系
• 运动学方程：描述位置、姿态与速度、角速度的关系

先看平动动力学方程，在弹体坐标系下写出来是这样的：

m * (dV/dt + ω × V) = F_aero + F_thrust + m * g

其中V是速度矢量，ω是角速度矢量，×表示叉乘。这里有个坑——叉乘项ω×V是耦合项，很多初学者会漏掉。我记得第一次做六自由度仿真时，漏了这项，结果导弹飞着飞着就“飘”起来了，怎么调参数都不对。后来查了三天才找到原因。

转动动力学方程：

I * (dω/dt) + ω × (I * ω) = M_aero + M_thrust

I是惯性张量矩阵。注意，对于轴对称导弹，I通常是对角矩阵，但非轴对称弹体（比如带大边条翼的）就要考虑惯性积了。

3.2 气动力与力矩模型：导弹的“肌肉”

气动力模型是导弹动力学中最“玄学”的部分。为什么这么说？因为气动数据通常来自风洞实验或CFD计算，而我们在仿真中用的是气动系数模型。

常用的气动力模型形式：

升力系数: CL = CL0 + CLα * α + CLδe * δe + CLq * (q * c / 2V)
阻力系数: CD = CD0 + CDα * α² + CDδe * δe²
侧力系数: CY = CYβ * β + CYδr * δr

这里α是攻角，β是侧滑角，δe是升降舵偏角，q是俯仰角速度。你可能会问：为什么阻力系数里有α²项？因为阻力与攻角近似成抛物线关系，这是我在做某型导弹气动辨识时验证过的。

力矩模型类似：

俯仰力矩系数: Cm = Cm0 + Cmα * α + Cmδe * δe + Cmq * (q * c / 2V)
偏航力矩系数: Cn = Cnβ * β + Cnδr * δr + Cnr * (r * b / 2V)
滚转力矩系数: Cl = Clβ * β + Clδa * δa + Clp * (p * b / 2V)

3.3 推力模型：导弹的“心脏”

推力模型相对简单，但同样有讲究。固体火箭发动机的推力-时间曲线通常由装药设计决定，典型形式是：

F_thrust = F_max * f(t)

其中f(t)是归一化的推力-时间曲线，通常分为三个阶段：

• 点火段：推力快速上升（约0.1-0.3秒）
• 工作段：推力基本恒定（主推阶段）
• 拖尾段：推力缓慢下降（燃烧结束）

推力方向通常沿弹体纵轴，但要注意：如果发动机喷管有偏转（比如推力矢量控制），推力方向会偏离弹体轴线，产生额外的控制力矩。

推力模型在弹体坐标系下的表达：

F_thrust_body = [F_thrust * cos(δ_tv); 0; -F_thrust * sin(δ_tv)]

δ_tv是推力矢量偏转角。嗯，这里要注意，推力矢量控制通常只在低速段或大攻角时启用，因为气动舵面在低速时效率很低。

3.4 知识体系总览

下面这张图是我自己画的，把本章的核心逻辑串起来了。你仔细看，会发现所有模型最终都汇入刚体运动方程：

3.5 模型集成与仿真实现

把上面三个模型组合起来，就得到了完整的导弹动力学仿真模型。我个人习惯用状态空间法来组织：

状态向量: X = [x, y, z, Vx, Vy, Vz, φ, θ, ψ, p, q, r]^T
输入向量: U = [δe, δa, δr, δ_tv]^T
输出向量: Y = [位置, 速度, 姿态, 过载]^T

在Python中实现时，我通常这样写：

def missile_dynamics(t, X, U, params):
    # 解包状态
    x, y, z, Vx, Vy, Vz, phi, theta, psi, p, q, r = X
    
    # 计算气动力和力矩
    F_aero, M_aero = aero_model(X, params)
    
    # 计算推力
    F_thrust, M_thrust = thrust_model(t, U, params)
    
    # 计算重力
    g_vec = gravity_model(z, params)
    
    # 刚体运动方程
    dXdt = rigid_body_equations(X, F_aero, M_aero, F_thrust, M_thrust, g_vec, params)
    
    return dXdt

3.6 参数整定的“坑”与“道”

动力学模型建好后，参数整定是另一门学问。我总结了几条经验：

• 气动参数优先：先校准气动系数，再调其他参数。气动不准，后面全是白费。
• 惯性参数要实测：导弹的质心位置、转动惯量最好通过实测得到，不要用理论估算。我见过一个项目，理论计算的质心偏了5%，结果控制律怎么调都振荡。
• 推力曲线要实测：固体发动机的推力-时间曲线受温度影响很大，常温下测的和低温下测的可能差20%。

好了，这一章的内容就到这里。动力学建模是制导系统的基础，你花多少功夫在上面，后面控制律设计就有多顺利。记住：模型不准，控制白费。

---

公众号：蓝海资料掘金营，微信 deep3321