第二章 相对运动方程：建立拦截几何、视线角、相对速度等基本数学模型
各位同学，咱们接着聊。上一章我讲了比例导引法的核心思想——说白了就是让导弹的转弯速率跟视线角速率成正比。但光有想法不行，你得有数学工具去描述它。这一章，我们就来搭建这个数学模型。
我个人习惯，在讲任何制导律之前，先把“拦截几何”画清楚。你想想看，导弹和目标是两个在空中飞行的点，它们之间的相对关系怎么描述？这就是我们要解决的问题。
2.1 拦截几何的基本要素
先看一个最简单的二维场景。假设导弹在M点，目标在T点。我们关心什么呢？
- 视线（LOS）：从导弹指向目标的直线。这是最关键的参考线。
- 视线角（q）：视线与某个固定参考方向（比如正北或正东）的夹角。我习惯用水平方向做参考，这样计算方便。
- 弹目距离（R）：导弹与目标之间的直线距离。这个值随着时间变化，最终归零就是命中。
嗯，这里要注意：视线角不是导弹的指向角，也不是目标的方位角。它是连接两者的那条线的角度。这个区别，我在项目里见过不少新手搞混。
核心概念：视线角速率（dq/dt）是比例导引法的灵魂。导弹的过载指令直接跟它成正比。
2.2 相对运动方程的推导
好，现在我们来建立方程。我习惯从极坐标入手，因为拦截问题天然适合用极坐标描述。
设导弹位置为 (xM, yM)，目标位置为 (xT, yT)。那么：
R = sqrt((x_T - x_M)² + (y_T - y_M)²)
q = atan2(y_T - y_M, x_T - x_M)这两个式子看着简单，但背后有大学问。我曾经在仿真中遇到过一个问题：atan2的返回值范围是(-π, π]，如果你不做处理，视线角会在±π处跳变。这会导致制导指令瞬间反转，导弹会像抽风一样乱抖。
避坑指南：我曾经因为没处理好视线角的连续性，导致半实物仿真时舵机直接打满舵。后来我养成了一个习惯——对视线角做unwrap处理，保证角度连续变化。
接下来，我们对R和q求时间导数。这个过程有点繁琐，但结果很漂亮：
dR/dt = V_T * cos(θ_T - q) - V_M * cos(θ_M - q)
dq/dt = [V_T * sin(θ_T - q) - V_M * sin(θ_M - q)] / R其中VM、VT是导弹和目标的速度大小，θM、θT是它们的航向角。
这两个方程，就是相对运动方程的核心。第一个描述弹目距离的变化率，第二个描述视线角的变化率。你仔细看，dR/dt其实就是接近速度，而dq/dt就是我们最关心的视线角速率。
2.3 相对速度与接近速度
在实际工程中，我们更常用的是相对速度的概念。相对速度Vrel是目标相对于导弹的速度矢量：
V_rel = V_T - V_M把这个矢量分解到视线方向和垂直视线方向：
- 径向分量（Vr）：沿视线方向，就是-dR/dt。正值表示远离，负值表示接近。
- 横向分量（Vθ）：垂直视线方向，等于R * dq/dt。
我建议你记住这个关系：R * dq/dt = VT * sin(θT - q) - VM * sin(θM - q)。这个式子会在后续的制导律推导中反复出现。
个人经验：我在做半实物仿真时，经常用这个公式来反推目标的机动情况。如果视线角速率突然变大，说明目标在做大过载机动。这时候就要调整制导参数了。
2.4 三维空间的扩展
二维搞清楚了，三维其实就是在俯仰和偏航两个通道分别应用比例导引。我习惯用视线坐标系来描述：
| 坐标系 | 定义 | 用途 |
|---|---|---|
| 视线坐标系 | 原点在导弹，x轴指向目标 | 描述相对运动最直观 |
| 弹体坐标系 | 原点在导弹，x轴沿弹体纵轴 | 用于控制律设计 |
| 惯性坐标系 | 固定在地面 | 用于导航和仿真 |
三维情况下，视线角速率分解为俯仰通道和偏航通道两个分量。每个通道独立应用比例导引，这就是所谓的“解耦设计”。
不过说实话，完全解耦只是一种近似。实际上两个通道之间存在耦合，尤其是当导弹做大机动时。我在某型导弹的研制中就遇到过这个问题——俯仰通道的机动会在偏航通道产生耦合干扰。后来我们加了前馈补偿才解决。
2.5 知识体系总览
说了这么多，我画个图帮你理清思路。这一章的核心逻辑是这样的：
这张图把这一章的逻辑串起来了。从拦截几何出发，建立相对运动方程，最终服务于制导指令的生成。你把这个框架记在脑子里，后面学起来就顺了。
2.6 工程实现中的注意事项
最后，我结合自己的工程经验，给你几个实用建议：
- 视线角速率的获取：实际系统中，我们通常用导引头直接测量视线角速率，而不是通过位置差分。因为差分会放大噪声。
- 滤波处理：测量得到的视线角速率一定要滤波。我习惯用二阶低通滤波器，截止频率根据弹体特性来选。
- 初始段处理：在发射初始段，弹目距离R很大，视线角速率很小。这时候要防止制导指令过小导致失控。我一般会加一个最小指令限制。
- 末端奇异性：当R趋近于0时，dq/dt的计算会出现奇异性。实际工程中会在R小于某个阈值时切换到直瞄模式。
总结一下：相对运动方程是比例导引法的数学基础。你只要记住两个核心方程——dR/dt和dq/dt，以及它们背后的物理意义，后面的内容就水到渠成了。
好，这一章就到这里。相对运动方程是后续所有推导的起点，建议你亲手推导一遍，把每个符号的含义都搞清楚。下一章我们就要进入比例导引法的核心——制导律的推导了。
公众号:蓝海资料掘金营，微信deep3321