比例导引法（PN）在三维空间中通过实时计算指令加速度 $ a_{\text{cmd}} = N \cdot (\omega \times V_m) $ 实现拦截，其中 $ \omega = \dot{r} \times r / |r|^2 $，需对 $ |r| $ 加阈值保护、限制加速度幅值并用稳定 $ dt $ 积分更新位置与速度。
什么是比例导引法（PN）在三维空间中的核心计算逻辑
比例导引法本质是让拦截器的视线角速度与目标相对运动成正比，通过控制法向加速度实现渐进收敛。它不依赖目标机动模型，只用当前相对位置和速度，适合实时性要求高的场景。
关键不是“解微分方程”，而是每帧计算一个指令加速度 a_cmd：
a_cmd = N * (ω × V_m)，其中 N 是导航比（通常 3–5），ω 是视线角速度（ṙ × r / |r|²），V_m 是拦截器速度矢量。
-
r和ṙ必须是目标相对于拦截器的位置/速度矢量（即r = r_target - r_interceptor，ṙ = v_target - v_interceptor） - 三维中所有量都是
glm::vec3或自定义三维矢量，叉乘顺序不能反（ω × V_m不等于V_m × ω） - 直接用
ω公式计算易因|r|过小导致数值爆炸，必须加长度阈值保护
如何避免除零、抖动和过冲——实际工程中的三处硬坑
原公式在 |r| 接近零或 r 几乎平行于 ṙ 时会失效，这不是理论问题，是实操必踩点。
- 对
|r|加下限保护：float r_len = fmaxf(length(r), 1e-3f);，否则除零或浮点溢出会导致a_cmd突变为inf或nan - 视线角速度
ω的分母是r_len * r_len，不是r_len；漏平方会导致远距离响应过弱 - 指令加速度需限制幅值：
a_cmd = normalize(a_cmd) * fminf(length(a_cmd), a_max)，否则高速接近时加速度爆炸，物体瞬间甩飞
怎么把 a_cmd 转成可执行的运动更新（含积分与朝向对齐）
算出加速度只是第一步，C++ 中真正让物体“动起来”需要两件事：积分运动学方程 + 对齐推进方向。多数人卡在这步，以为给个加速度就完事了。
- 使用显式欧拉积分即可（实时仿真够用）：
v += a_cmd * dt;，pos += v * dt;—— 但v必须是世界坐标系下的速度 - 若拦截器有朝向（如飞船机头），需将
a_cmd投影到机体坐标系再控制推力方向，或直接用四元数旋转a_cmd到世界系后累加 - 不要用
glm::rotate动态改模型矩阵来“模拟”运动——那只是视觉欺骗，物理上没加速度，PN 就彻底失效
C++ 实现时哪些库函数和类型选择直接影响稳定性
选错数据结构或数学库调用方式，会让 PN 在 20 帧后就开始绕圈或发散，和算法无关，纯属接口误用。
立即学习“C++免费学习笔记（深入）”；
- 务必用
glm::vec3（非float[3]或std::array）——它的cross、normalize、length是 SIMD 优化过的，且语义明确 - 避免手写叉乘：
glm::cross(ω, V_m)比自己展开 x/y/z 分量少 3 个符号错误机会 - 时间步长
dt必须来自稳定时钟（如glfwGetTime()差分），不能用帧率倒数——VSync 关闭时 dt 可能跳变 2x，PN 直接震荡
最常被忽略的是：PN 的收敛性严重依赖 dt 一致性。哪怕只有一帧 dt 异常大，v 就会突变，后续所有 r 和 ṙ 都错位——这时看轨迹像“抽风”，其实只是时钟没锁住。
