第3章导弹运动学建模

第1章：导弹运动学建模

各位同学，咱们今天聊聊导弹运动学建模。说实话，这是整个制导控制系统设计的基石。你想想看，连导弹怎么飞都描述不清楚，后面的控制算法就是空中楼阁。我个人习惯，每次接手新项目，第一件事就是把运动学模型吃透。

坐标系这东西，说白了就是给导弹的运动找个"尺子"。我见过太多新手，模型算出来结果不对，最后发现是坐标系搞混了。

常用的坐标系有这么几个：

地面坐标系（O_gX_gY_gZ_g）：原点固定在地面某点，X轴指向正北，Y轴指天，Z轴指向正东。这个坐标系用来描述导弹的绝对位置。
弹体坐标系（O_bX_bY_bZ_b）：原点在导弹质心，X轴沿弹体纵轴向前，Y轴在对称平面内垂直X轴向上，Z轴按右手定则确定。这个坐标系用来描述导弹的姿态。
速度坐标系（O_vX_vY_vZ_v）：原点也在质心，X轴沿速度方向，Y轴在对称平面内垂直速度向上，Z轴同样右手定则。这个坐标系用来分析气动力最方便。

关键点：坐标系之间的转换矩阵是建模的核心。比如从弹体坐标系到地面坐标系，需要用到欧拉角（俯仰角θ、偏航角ψ、滚转角φ）。我在项目中遇到过，有人把转换矩阵的乘法顺序搞反了，结果仿真出来的导弹在天上画圈圈。

嗯，这里要注意：欧拉角的定义顺序不是随便定的。我建议统一采用"3-2-1"顺序，也就是先滚转、再俯仰、最后偏航。这个顺序在工程界最常用，也最不容易出错。

导弹的运动，说白了就是三个平动加三个转动。六个自由度，每个都有对应的动力学方程。

平动方程（质心运动）：

m * dV/dt = F_总
其中 F_总 = F_推力 + F_气动 + F_重力

转动方程（绕质心转动）：

I * dω/dt + ω × (I * ω) = M_总
其中 M_总 = M_气动 + M_控制

看着简单吧？但实际用起来坑不少。我记得有一次做某型导弹的六自由度仿真，算出来的角速度总是发散。排查了两天，最后发现是惯性张量矩阵I的非对角项给忽略了。你想想看，导弹又不是完美的轴对称体，那些交叉项怎么能省？

实战建议：写代码时，先把完整的六自由度方程列出来，再根据实际情况做简化。千万别一上来就砍项，容易出问题。

气动模型，说白了就是描述导弹和空气之间的"互动"。完整的CFD计算太慢，工程上我们一般用气动系数法。

常用的简化形式：

这里α是攻角，δ是舵偏角，q是俯仰角速率。这些系数通常来自风洞实验或者查表。

避坑指南：我曾经在某个项目中，直接用了线性化的气动系数，结果在大攻角情况下仿真完全失真。后来才意识到，气动系数在攻角超过15度后就有明显的非线性。所以，如果你的导弹需要做大机动，一定要考虑非线性修正。

推力模型，很多人以为就是给个常数。其实不然。固体火箭发动机的推力随时间变化，而且变化还挺大。

典型的推力曲线分三个阶段：

工程上常用的简化模型：

F_thrust(t) = 
  F_max * (t / t_ignite),  t < t_ignite
  F_max * exp(-k * (t - t_burn)),  t > t_burn
  F_max,  其他情况

我个人习惯，在初步设计阶段用分段线性模型就够了。但到了详细设计阶段，一定要用实测的推力曲线数据。你想想看，推力误差5%，对射程的影响可能超过10%。

重力模型，看起来最简单：F_g = m * g。但这里有个细节——g不是常数。

地球是个椭球体，不同纬度和高度的重力加速度都不一样：

g(h, φ) = g0 * (R_e / (R_e + h))² * (1 + 0.0052884 * sin²φ - 0.0000059 * sin²2φ)

其中g0是海平面标准重力加速度（9.80665 m/s²），R_e是地球半径，h是高度，φ是纬度。

实战经验：对于近程导弹（射程几十公里），直接用常数g=9.8问题不大。但如果是远程导弹或者高精度制导，必须考虑g的变化。我记得有一次做远程弹道导弹的仿真，用常数g算出来的落点偏差了将近500米。后来换成变重力模型，精度一下子就上来了。

下面这张图，把本章的核心逻辑串起来了：

这张图把五个模块的关系说清楚了。你想想看，坐标系是"骨架"，运动方程是"肌肉"，气动、推力、重力是"外力"。缺了任何一个，模型都不完整。

我的习惯：每次建完模型，先用简单的弹道（比如垂直发射）做验证。如果连这个都算不对，那肯定有地方出错了。别急着做复杂机动仿真，先把基础打牢。

好了，这一章的内容就到这里。运动学建模是后面所有章节的基础，建议各位同学自己动手把代码写一遍。遇到问题别怕，调试的过程就是学习的过程。

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