第二节 相对运动学基础
各位同学，今天我们来聊聊相对运动学。说实话，这部分内容是整个制导律的基石。你想想看，导弹要打中目标，首先得搞清楚两者之间的相对关系——视线怎么转、距离怎么变、速度怎么配。我在项目里见过不少新手，一上来就猛调制导参数，结果连视线角速率都没算对，那肯定打不中啊。
2.1 视线角与视线角速率
先说说视线角。这个概念其实很直观——就是导弹和目标连线与某个参考方向之间的夹角。我个人习惯用 q 来表示，下标分 q_L（视线高低角）和 q_λ（视线方位角）。
核心定义：
- 视线角 q：弹目连线与基准线（通常是水平面或惯性系某轴）的夹角
- 视线角速率 dq/dt：视线角随时间的变化率，记作 q̇
为什么视线角速率这么重要？说白了，比例导引法的核心就是靠它来生成过载指令。我记得有一次做半实物仿真，发现脱靶量总是偏大，查了半天——原来是视线角速率滤波参数设错了。嗯，这里要注意：视线角速率不能直接用差分，必须做平滑滤波，否则噪声会把你整崩溃。
实际工程中，视线角通常由导引头测量得到。但导引头测的是弹体坐标系下的角度，需要转换到惯性系。我建议你养成习惯：所有制导律计算都在惯性系下进行，这样最干净、最不容易出错。
2.2 相对速度坐标系
接下来是相对速度坐标系。这个概念很多教材讲得绕，我换个说法：把导弹和目标的速度矢量放到同一个坐标系里看。
常用的坐标系有三个：
| 坐标系 | 原点 | 特点 | 我常用的场景 |
|---|---|---|---|
| 惯性坐标系 (I系) | 地面固定点 | 不随时间变化 | 全弹道仿真基准 |
| 视线坐标系 (L系) | 导弹质心 | x轴沿视线方向 | 制导律推导最方便 |
| 弹体坐标系 (B系) | 导弹质心 | x轴沿弹体纵轴 | 导引头测量输出 |
你可能会问：为什么要搞这么多坐标系？其实很简单——每个坐标系都有它最擅长的活儿。视线坐标系下写相对运动方程最简洁，弹体坐标系下导引头直接输出角度，惯性系下做积分最稳定。我刚开始做制导律设计时，总想用一个坐标系搞定所有事，结果推导出来的公式又长又乱。后来学乖了，该换系就换系，别硬撑。
我的小技巧：在代码里把坐标系转换写成独立函数，比如 euler2dcm()、dcm_transform()。这样主程序里只需要调用，逻辑清晰，调试也方便。
2.3 弹目相对运动方程
好了，重头戏来了。弹目相对运动方程，就是描述导弹和目标之间位置、速度、角度随时间变化的微分方程组。我直接给你最常用的形式——视线坐标系下的二维相对运动方程：
// 二维平面内，视线坐标系下的相对运动方程
// r: 弹目距离
// q: 视线角
// Vm: 导弹速度
// Vt: 目标速度
// θm: 导弹弹道倾角
// θt: 目标弹道倾角
dr/dt = Vt * cos(q - θt) - Vm * cos(q - θm)
r * dq/dt = Vm * sin(q - θm) - Vt * sin(q - θt)
这两个方程看着简单，但信息量很大。第一个方程描述距离变化率，第二个方程描述视线角速率。我当年推导这个方程时，在纸上画了整整三页的几何关系图。你想想看，导弹和目标都在动，角度关系确实容易搞混。
这里有个关键点：r * dq/dt 这一项，就是制导律的输入信号。比例导引法要的就是这个 dq/dt，乘以导航比 N，再乘以相对速度 Vc，就得到了需要的法向过载。
曾经踩过的坑：有一次我在做末制导段仿真，发现脱靶量突然变大。排查了三天，最后发现是相对速度 Vc 的符号搞反了。Vc = -dr/dt，当距离减小时 dr/dt 为负，Vc 为正。这个符号问题，我建议你写代码时专门加个注释，不然半年后自己都忘了。
三维情况稍微复杂一些，需要引入视线高低角和方位角两个通道。但核心思想一样——把三维运动分解到两个正交的平面内，每个平面单独用二维方程处理。我在实际项目中就是这么干的，简单可靠。
2.4 知识体系总览
为了让你对这部分内容有个整体把握，我画了一张结构图。你看完应该能明白：视线角是输入，相对运动方程是核心，坐标系转换是工具，三者缺一不可。
这张图把三个核心模块串起来了。你看，视线角和角速率是输入信号，坐标系是转换工具，相对运动方程是核心计算引擎。三者配合，才能输出制导律需要的全部运动信息。
避坑指南：我曾经在项目里犯过一个低级错误——直接用导引头输出的视线角速率做制导律计算，没做坐标系转换。结果导弹在转弯时指令完全反了。后来我养成了一个习惯：所有测量值先转到惯性系，再做制导律计算。这个习惯救了我好几次。
好了，相对运动学基础就讲到这里。这部分内容虽然基础，但真的非常重要。你想想看，如果连导弹和目标之间的相对关系都描述不清楚，后面的制导律设计就是空中楼阁。我建议你动手推导一遍二维相对运动方程，画个几何关系图，把每个角度、每个速度分量都标清楚。嗯，这样做一遍，比看十遍书都管用。
公众号:蓝海资料掘金营，微信deep3321