3、导弹运动学基础：坐标系定义与质心运动方程
各位同学，欢迎来到导弹制导系统的第三讲。今天我们要聊的，是整个制导系统的“地基”——运动学基础。说白了，就是搞清楚导弹在空间里到底是怎么飞的，我们怎么用数学语言去描述它的位置和姿态。
我个人习惯把这一章叫做“坐标系与姿态的哲学课”。为什么？因为坐标系选错了，后面所有的算法都会跑偏。我在项目中就见过好几次，因为坐标系定义不一致，导致仿真结果和实际试飞数据对不上，排查了整整一周才发现是坐标轴方向搞反了。嗯，这种坑，咱们今天就得提前填上。
3.1 坐标系定义：给导弹一个“家”
要描述导弹的运动，首先得有个参考基准。就像你说“我在北京”，得先知道北京在地球上的位置一样。导弹制导里，我们常用的坐标系有三个层次：地心坐标系、弹体坐标系、速度坐标系。
3.4.1 地心坐标系（ECEF）
地心坐标系，顾名思义，原点在地球中心。它的Z轴指向北极，X轴指向本初子午线与赤道的交点，Y轴按右手定则确定。这个坐标系是固定的，不随导弹转动。
为什么需要它？ 因为导弹的飞行距离可能跨越上千公里，这时候地球曲率就不能忽略了。地心坐标系能让我们精确描述导弹相对于地球的位置。
重要概念： 地心坐标系是惯性系吗？严格来说不是，因为它随地球自转。但在短时间、短距离的制导问题中，我们常把它近似为惯性系。我建议你在做高精度仿真时，一定要考虑地球自转的影响，否则误差会累积。
3.1.2 弹体坐标系
弹体坐标系是固定在导弹上的。原点在导弹质心，X轴沿弹体纵轴指向头部，Y轴在弹体对称平面内垂直于X轴指向上方，Z轴按右手定则指向右侧。
这个坐标系有什么用？它直接描述了导弹的“姿态”——导弹是抬头还是低头？是左转还是右转？所有舵面的控制指令，最终都要转换到弹体坐标系里执行。
我的经验： 在写飞控代码时，我习惯把弹体坐标系作为“主坐标系”。所有传感器数据（陀螺仪、加速度计）都是在这个坐标系下测量的。你想想看，如果传感器数据先转换到其他坐标系再处理，不仅计算量大，还容易引入误差。
3.1.3 速度坐标系
速度坐标系也叫气流坐标系。它的原点也在导弹质心，但X轴沿着导弹速度方向，Y轴在对称平面内垂直于速度方向指向上方，Z轴按右手定则确定。
这个坐标系和弹体坐标系之间差了一个“攻角”和“侧滑角”。说白了，速度坐标系描述的是导弹“实际飞行的方向”，而弹体坐标系描述的是导弹“头指向的方向”。
为什么会这样？因为导弹飞行时，气流会从各个方向吹过来。如果导弹有攻角，它的头部指向就和速度方向不一致了。这个差异，正是我们控制导弹的关键。
| 坐标系 | 原点 | X轴方向 | 主要用途 |
|---|---|---|---|
| 地心坐标系 | 地心 | 指向本初子午线 | 全局位置描述 |
| 弹体坐标系 | 导弹质心 | 弹体纵轴 | 姿态控制、传感器 |
| 速度坐标系 | 导弹质心 | 速度方向 | 气动力计算 |
3.2 欧拉角与姿态描述
有了坐标系，接下来要解决一个问题：怎么描述导弹从地心坐标系转到弹体坐标系？答案就是欧拉角。
欧拉角有三个：偏航角（ψ）、俯仰角（θ）、滚转角（φ）。它们分别描述了导弹绕Z轴、Y轴、X轴的旋转。
旋转顺序很重要！ 我刚开始学的时候，总觉得先转哪个轴都一样。直到有一次，我用不同的旋转顺序算同一个姿态，结果差了十几度。嗯，这里要注意：导弹制导中，我们通常采用“3-2-1”顺序，即先偏航、再俯仰、最后滚转。
避坑指南： 我曾经在代码里把旋转矩阵的顺序写反了，导致仿真时导弹一直往反方向飞。排查了三天才发现是矩阵乘法顺序错了。记住：旋转矩阵是左乘还是右乘，取决于你用的是“向量旋转”还是“坐标系旋转”。我建议你统一用“坐标系旋转”的视角，这样不容易乱。
欧拉角还有一个“奇点”问题。当俯仰角接近±90°时，偏航和滚转的运动会耦合在一起，出现“万向锁”。这时候欧拉角就失效了。怎么办？
我个人习惯在工程中用四元数代替欧拉角。四元数没有奇点，而且计算效率更高。但四元数不直观，调试时我还是会转回欧拉角来看。
3.3 导弹质心运动方程
好了，坐标系和姿态都搞定了，现在可以写运动方程了。导弹质心运动方程，说白了就是牛顿第二定律在导弹上的应用：F = ma。
但导弹上的力很复杂：推力、气动力、重力。而且这些力是在不同坐标系下定义的。推力在弹体坐标系下，气动力在速度坐标系下，重力在地心坐标系下。所以，写方程的第一步，就是把所有力转换到同一个坐标系下。
我建议你统一转换到地心坐标系（或惯性系）下写方程。这样最直观，也最容易和导航数据对接。
质心运动方程的矢量形式如下：
m * dV/dt = F_thrust + F_aero + F_gravity其中：
- m 是导弹质量（随时间变化，因为燃料在消耗）
- V 是速度矢量（在地心坐标系下）
- F_thrust 是推力矢量（沿弹体X轴）
- F_aero 是气动力矢量（在速度坐标系下分解为升力、阻力、侧力）
- F_gravity 是重力矢量（指向地心）
关键点： 这个方程看起来简单，但实际写代码时，每一步都要小心。比如质量m是随时间变化的，你不能当成常数。再比如气动力F_aero依赖于导弹的速度、高度、攻角，这些变量又是耦合的。我建议你从最简单的二维模型开始，先忽略侧向运动，把纵向通道调通了，再扩展到三维。
另外，质心运动方程只是“平动”部分。导弹还有“转动”部分，也就是姿态动力学方程。那部分我们下一章再讲。但你要记住：平动和转动是耦合的。舵面偏转会改变姿态，姿态改变会影响气动力，气动力又反过来影响平动。这就是导弹飞行的“闭环”。
我的建议： 初学者可以先从“六自由度仿真”入手。网上有很多开源代码，比如MATLAB的Aerospace Toolbox。你不需要自己从头写所有方程，但一定要理解每个参数的含义。我记得我第一次跑六自由度仿真时，看着导弹在屏幕上飞起来，那种感觉真的很棒。
好了，这一章的内容就到这里。总结一下：我们讲了三种坐标系（地心、弹体、速度），讲了欧拉角描述姿态的方法，还讲了质心运动方程的基本形式。这些都是后续章节的基础，一定要吃透。
下一章，我们会深入导弹的转动动力学，也就是姿态控制的核心。到时候，我会分享一个我在项目中遇到的“滚转失控”的案例，保证让你印象深刻。
公众号:蓝海资料掘金营，微信deep3321