4. 最优制导问题建模：相对运动方程、性能指标选取、终端约束与过程约束
好，咱们进入正题。前面几章我们把最优控制的理论框架搭起来了，现在要落地到制导问题上。说白了，就是把「导弹怎么飞」这件事，用数学语言描述成一个优化问题。
我个人习惯，建模这一步花的时间往往比求解还多。模型建得不对，后面算得再漂亮也是白搭。我在项目中就吃过这个亏——有一次把相对运动方程简化得太狠，结果仿真跑出来弹道看着挺美，一上六自由度模型就崩了。嗯，教训深刻。
4.1 相对运动方程：描述「追」与「逃」的数学语言
制导问题的核心，是导弹和目标之间的相对运动。你想想看，导弹要拦截目标，本质上就是不断缩小两者之间的位置偏差。这个偏差，我们通常用相对距离和视线角来描述。
最常见的模型是二维平面内的相对运动方程。假设导弹和目标都在同一平面内运动，我们定义：
- r：导弹与目标之间的相对距离（标量）
- λ：视线角，即从导弹指向目标的连线与参考方向的夹角
- VM、VT：导弹和目标的速度
- θM、θT：导弹和目标的航向角
那么，相对运动方程可以写成：
ṙ = V_T * cos(λ - θ_T) - V_M * cos(λ - θ_M)
λ̇ = [V_T * sin(λ - θ_T) - V_M * sin(λ - θ_M)] / r这里要注意，r 出现在分母上。这意味着当导弹接近目标时，视线角速率 λ̇ 会变得非常敏感。我在做半实物仿真时，就遇到过因为 r 趋近于零导致数值爆炸的情况——后来加了小量保护才解决。
核心要点：相对运动方程是制导律设计的基础。它描述了「状态量」（r, λ）如何随时间演化，而我们的控制量——通常是导弹的法向过载——就藏在 θM 的变化率里。
对于三维空间，我们需要引入两个视线角（俯仰和偏航），方程会更复杂一些，但思路是一样的。我个人习惯先用二维模型做概念验证，再扩展到三维。
4.2 性能指标选取：你想让导弹怎么飞？
性能指标，说白了就是「好」的标准。不同的任务场景，对「好」的定义完全不同。
在最优制导中，最常见的性能指标是：
- 最小脱靶量：终端时刻的相对距离最小。这是最基本的要求，打不中目标一切免谈。
- 最小控制能量：即 ∫ u² dt 最小。对应导弹的过载消耗，控制能量越小，导弹的机动裕度越大。
- 最小时间：尽快拦截目标。适用于高速目标或紧急拦截场景。
- 终端角度约束：除了脱靶量，还要求命中时刻的视线角或弹道角满足特定值。比如攻顶弹要求大落角。
实际工程中，我们通常取性能指标为脱靶量与控制能量的加权和：
J = φ[x(t_f)] + ∫₀ᵗᶠ L(x, u, t) dt其中 φ 是终端代价（比如脱靶量），L 是过程代价（比如控制能量）。
我的经验：权重的选取非常关键。我曾经在一个项目中，把控制能量的权重设得太高，结果导弹全程「舍不得」机动，脱靶量很大。后来把权重调低了一个数量级，效果立竿见影。建议你从 1:1 开始试，然后根据仿真结果微调。
4.3 终端约束：命中时刻必须满足的条件
终端约束，就是导弹在命中目标那一刻必须满足的硬性条件。最常见的终端约束是：
- 零脱靶量：r(t_f) = 0。这是制导问题的基本要求。
- 终端视线角约束：λ(t_f) = λ_f。比如要求以特定角度命中目标。
- 终端速度方向约束：要求导弹速度方向与目标速度方向成特定夹角。
在数学上，终端约束可以写成：
ψ[x(t_f), t_f] = 0其中 ψ 是一个向量函数，包含了所有需要满足的终端条件。
注意：终端约束越多，问题的求解难度越大。有时候你加了一个终端角度约束，可能就找不到解析解了，只能上数值方法。我建议你从最简单的零脱靶量开始，逐步增加约束。
4.4 过程约束：飞行过程中的限制
过程约束，是导弹在飞行过程中必须遵守的限制。这些约束来自物理限制和工程限制：
| 约束类型 | 具体内容 | 数学表达 |
|---|---|---|
| 控制量约束 | 导弹最大可用过载 | |u| ≤ umax |
| 状态量约束 | 攻角限制、动压限制 | |α| ≤ αmax, q ≤ qmax |
| 视场角约束 | 导引头最大跟踪角 | |λ - θM| ≤ βmax |
过程约束的存在，使得最优制导问题从「无约束优化」变成了「有约束优化」。求解难度直接上了一个台阶。
我曾经在一个项目中，忽略了导引头的视场角约束。结果仿真出来的最优弹道，导弹在末端需要大角度转弯，导引头直接丢失目标。嗯，那次教训让我记住了：过程约束不是摆设，是硬边界。
4.5 知识体系总览
下面这张图，把本章的核心逻辑串起来了。你可以把它当作建模阶段的检查清单：
你看，建模不是孤立地写几个方程，而是要把运动学、优化目标、边界条件、工程限制这四块拼在一起。缺了任何一块，你得到的「最优解」在实际系统中都可能不成立。
我个人习惯，在建模阶段会画一张类似的图，把每个模块的输入输出关系理清楚。这样后面推导公式时，思路不会乱。
本章小结：最优制导问题建模，本质上就是回答四个问题——系统怎么动？什么算好？终点要什么？路上不能碰什么？把这四个问题用数学语言回答清楚，剩下的就是求解了。
公众号:蓝海资料掘金营，微信deep3321