第3章运动学建模

3. 运动学建模：拦截几何、相对运动方程、视线角速率概念

好，咱们进入第三章。这一章，说白了就是给拦截问题搭个数学舞台。你想想看，导弹追目标，总得有个坐标系、有个几何关系吧？我个人习惯，先把拦截几何画清楚，再推导相对运动方程，最后引出那个贯穿全程的核心概念——视线角速率。

我在项目里见过不少新手，一上来就盯着复杂的微分方程看，结果连最基本的几何关系都没搞明白。嗯，咱们一步步来。

先定义几个关键点：

拦截几何，说白了就是描述导弹和目标在空间中的相对位置关系。我建议你脑子里先有个二维平面图：

核心几何要素：

这里有个关键点：拦截问题本质上是一个追逐问题。导弹要做的，就是不断调整自己的速度方向，使得最终与目标相遇。我在做某型空空导弹项目时，发现很多算法失效，根源就在于初始拦截几何没分析透——说白了就是没算清楚“谁在谁的哪个方位”。

下面这张图，是我用 SVG 画的拦截几何示意图，你可以直观感受一下：

_M V_T

💡 个人经验：画图时，我习惯把导弹放在左侧，目标放在右侧。这样视线角 λ 从水平基准线逆时针测量为正，符合大多数教材的习惯。你如果做仿真，建议统一这个约定，否则后面符号搞混了很麻烦。

几何画好了，接下来要用数学描述这个动态过程。相对运动方程，说白了就是描述导弹和目标之间相对位置随时间变化的规律。

定义相对位置矢量：

r = r_T - r_M

其中 r_T 和 r_M 分别是目标和导弹的位置矢量。

对时间求导，得到相对速度：

ṙ = V_T - V_M

再求导，得到相对加速度：

r̈ = a_T - a_M

这里 a_T 和 a_M 分别是目标和导弹的加速度矢量。

在实际工程中，我们更关心的是在视线坐标系下的表达。把相对运动方程投影到视线方向和垂直于视线的方向，会得到两个标量方程：

方向	方程	物理含义
视线方向（纵向）	r̈ - rλ̇² = a_Tr - a_Mr	距离变化率受径向加速度和离心加速度影响
视线法向（横向）	rλ̈ + 2ṙλ̇ = a_Tλ - a_Mλ	视线角加速度受哥氏加速度和切向加速度影响

⚠️ 注意：上面第二个方程中的 2ṙλ̇ 项，就是哥氏加速度。我在做制导律设计时，曾经忽略过这一项，结果仿真结果跟实际飞行数据对不上。后来查了半天才发现是这里出了问题。你想想看，导弹高速接近目标时，ṙ 很大，这一项的影响不容忽视。

好，终于到了这一章的重头戏——视线角速率 λ̇。

视线角速率，就是视线角 λ 随时间的变化率。它反映了视线转动的快慢。为什么说它是制导的灵魂？

从相对运动方程中，我们可以解出 λ̇ 的表达式：

λ̇ = [V_T sin(η_T) - V_M sin(η_M)] / r

其中 η_T 和 η_M 分别是目标速度矢量和导弹速度矢量与视线之间的夹角（称为前置角）。

💡 避坑指南：我曾经在某个项目中，直接用了这个公式计算 λ̇，但没考虑传感器噪声。结果制导指令抖得厉害，导弹像喝醉了酒一样。后来加了低通滤波器才稳定下来。所以，理论公式虽好，工程实现时一定要考虑噪声和延迟。

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

从这张图你可以看到，拦截几何是基础，相对运动方程是桥梁，而视线角速率则是通往制导律设计的钥匙。三者环环相扣，缺一不可。

⚠️ 重要提醒：很多教材把视线角速率直接当作已知量，但在实际系统中，它往往需要通过滤波估计得到。我见过一个失败的案例，就是因为直接用差分法计算 λ̇，结果噪声放大导致制导系统发散。记住：微分放大噪声，积分抑制噪声。

好了，这一章的内容就到这里。运动学建模是整个制导问题的基石，后面的所有制导律设计，都建立在这套几何和方程之上。你如果能把这章的内容吃透，后面学比例导引、最优制导就会轻松很多。