做这个课题的第一周我基本都在怀疑人生。比例导引PNG被写进那么多教材不是没道理的——视线角速率乘一个导航常数导弹就能沿着一条漂亮的碰撞三角形轨迹飞向目标。但导师一句话把我问住了PNG能保证导弹在第25秒命中吗我愣住了。这就是冲击时间控制制导律要解决的问题能不能让飞行器不只在空间上收敛到目标还在时间上精确命中指定时刻。后来我基于混合比例导引设计了一款两级冲击时间控制制导律用Matlab把完整仿真跑通。从推导思路到代码细节再到参数整定和几个容易翻车的坑这篇文章一次说清楚。先给结论这套方案的本质是在比例导引加速度上叠加一个时间误差偏置项并通过两级策略控制偏置项的介入时机。第一级用纯比例导引快速把航向角压到碰撞三角形附近第二级再让时间偏置项逐步介入精确修正剩余飞行时间。实测下来在期望冲击时间比自由飞行时间晚3秒左右的工况下命中时刻误差可以控制在0.05秒以内脱靶量小于0.1米。如果你正在做齐射协同、多弹同时到达相关的制导律仿真或者只想搞清楚冲击时间控制到底怎么落地这篇应该能帮到你。1. 冲击时间控制到底在控制什么从PNG的盲区到两级设计的动机1.1 先把问题用数学写清楚目标静止导弹以恒定速度 V 飞行期望命中时刻为 Td。定义两个量实际剩余飞行时间估计值Tgo期望剩余飞行时间Td - t两者之差就是时间误差e_t (Td - t) - Tgo控制目标非常直白让 e_t 收敛到 0并且让相对距离 R 同时收敛到 0。换句话说既要命中又要在指定时刻命中。剩余飞行时间的估计是绕不开的第一步。最朴素的方法是用当前距离除以速度Tgo R / V。这个公式对大前置角、大过载机动的情况误差很大因为导弹并不是沿视线直线飞行。工程上更常用的是基于接近速率的估计Tgo -R / Rdot其中 Rdot -(rx·vx ry·vy) / R表示相对距离的变化率。这个式子把当前速度方向的前置角影响考虑进去了在导弹已经基本对准目标时非常准。缺点是在接近速率趋近于零比如垂直飞向目标时分母会出问题仿真时要做下限保护我后面代码里会给处理办法。1.2 PNG为什么解决不了准时命中这件事比例导引的加速度指令是 a N·V·λ̇N 是导航常数。它保证的是脱靶量收敛只要 N 2初始条件不极端导弹最终会进入碰撞三角形零控脱靶量趋近于零。但PNG没有任何一个参数是时间误差的显式通道。有人可能会说N 大一点导弹转弯猛一点飞行时间不就短了确实会变但这是隐式影响不是可控的。PNG的N只能改变收敛速度不能精确对准某个具体时刻。你想要导弹在第25.0秒命中PNG给不了你这种精度。想精确控制命中时刻必须在加速度指令里加一个专属于时间误差的通道——这就是偏置项存在的意义。1.3 为什么必须做成两级而不是直接叠加偏置直觉上最简单的方式是一开始就把偏置项加上让时间误差从第一秒开始修正。但实际仿真跑下来你会发现这条路很难走通。原因有两个。第一制导初期航向误差通常很大视线角速率 λ̇ 也大PNG项本身就在激烈操舵。此时叠加时间修正偏置相当于两个控制器争夺同一个执行机构。弹道会变得极其绕法向过载频繁顶到上限时间误差不但没有收敛反而可能被越带越大。第二越靠近目标Tgo越小偏置项里那个 V/Tgo 的增益会急剧放大。如果偏置从一开始就满负荷工作末端大概率出现过载饱和导致脱靶。所以工程上必须把制导过程拆成两段第一段只负责航向收敛把导弹带入一个视线角速率已经很小、弹道几何接近稳定的状态第二段再让时间修正偏置逐步介入。这就是两级的由来。这个思路的本质是解耦——先把空间问题解决个大概再用剩余的时间专门处理时间约束。1.4 混合比例导引的混合到底指什么很多论文里把这种结构叫作混合比例导引其实混合指的是加速度指令由两部分组成——比例导引项加时间误差偏置项。它不是两种独立制导律的切换而是同一个加速度指令里两项的混合。两级实现则体现为偏置项介入权重的变化第一级权重为0第二级权重从0平滑过渡到1。这么设计的好处是比例导引项始终在保证了命中几何的收敛性偏置项只在需要的时候介入避免了早期耦合和末端爆炸。后面仿真会证明这个结构比全程单级偏置稳定得多。2. 制导律构造加速度形式、偏置项设计与切换逻辑2.1 加速度指令的完整结构我采用的加速度指令形式如下a_cmd N·V·λ̇ w · kb · V/Tgo · e_t其中N·V·λ̇ 是比例导引项N 在第一级用 N1第二级用 N2e_t (Td - t) - Tgo时间误差kb 是偏置比例增益无量纲需要整定w 是两级切换权重取值范围 0 到 1整个式子看着简单但每一项都有讲究。比例导引项负责命中偏置项负责准时权重 w 负责什么时候开始准时。2.2 偏置项为什么要写成 kb·V/Tgo·e_t先说量纲V 单位是 m/se_t 单位是 sTgo 单位是 s乘完是 m/s²正好是加速度单位。这说明这个形式在量纲上是自洽的。再说物理直觉。法向加速度改变的是弹道曲率曲率一变导弹实际飞行的路径长度就变了剩余飞行时间 Tgo 自然跟着变。偏置项的增益 V/Tgo 意味着什么越接近目标Tgo 越小同样的时间误差需要的法向加速度越大。这符合实际你离目标很远时轻轻偏一下航线路径长度就能差出好几秒等你快到了才发现时间差了 0.5 秒想靠微调路径来弥补那必须大幅改变曲率才行。增益后面乘的 e_t 相当于一个比例控制器。e_t 为正说明实际估计剩余时间比期望剩余时间短导弹会早到偏置项就让导弹往外飘一点绕一点路e_t 为负说明会晚到偏置项就让导弹尽量切近路把路径缩短。为什么不用 PID 结构我一开始也试过加积分项但后来发现比例就够了。因为 Tgo 本身是个不断变化的量积分容易引入严重的滞后和超调尤其在末端会顶限幅。这个制导问题本质上是时变的比例项配合限幅和死区已经能解决大部分场景。2.3 切换逻辑怎么定我为什么用剩余距离阈值两级切换条件有几种做法按剩余距离切换当 R Rsw 时切到第二级按时间切换当 t t_sw 时切换按时间误差大小切换当 |e_t| e_sw 时切换我最终选了第一种Rsw 取初始距离的 50%~70%。主要原因是几何直观、好调参。初始距离 5000 米Rsw 取 3000 米意味着导弹先飞 2000 米左右做航向修正进入相对稳定的追击状态后再开始修时间。按时间切换需要事先知道比较靠谱的 t_sw但 t_sw 本身就跟弹道有关容易先有鸡还是先有蛋。按时间误差切换虽然概念上挺合理但如果在 e_t 很大的情况下就切进去偏置项一上来就是大幅值同样容易顶限幅。所以我用剩余距离做主切换条件。切换不能是阶跃式的。如果 w 直接从 0 跳到 1加速度指令会出现一个明显跳变弹道上能看见一个折点末端时间误差还会跟着抖一下。解决办法是加一个过渡带w 通过剩余距离的线性插值来变化。w clamp((Rsw - R) / Rw, 0, 1)比如 Rw 取 500 米那么从 R 3000 米到 R 2500 米这 500 米范围内w 从 0 线性增长到 1。这段过渡让偏置项温和地介入系统实测弹道和过载曲线都平滑很多。3. Matlab仿真实现状态方程、Tgo在线估计与完整代码3.1 仿真用的状态方程我用的状态变量是 X [x; y; vx; vy]目标静止导弹恒速 V。制导律输出的是法向加速度 a_cmd它改变的是速度方向角 θ而不是速度大小。速度方向角的动力学是 θ̇ a_cmd / V。把直角坐标下的速度分量展开vx V·cosθ vy V·sinθ求导就得到v̇x -a_cmd·sinθ v̇y a_cmd·cosθ这个形式适合直接用 ode45 数值积分。状态方程不难关键是每一步都要实时计算视线角速率、剩余距离、接近速率、Tgo 和时间误差再把制导指令算出来。3.2 容易出错的辅助量计算仿真循环里几个量要算对顺序也不能乱相对距离rx xt - xry yt - yR sqrt(rx² ry²)视线角速率λ̇ (rx·vy - ry·vx) / R²。注意分子别写反写反了导引项符号就错了导弹会往外飞而不是往目标飞接近速率Rdot -(rx·vx ry·vy) / R。这个量正常是正的表示距离在缩小剩余时间Tgo R / Rdot。如果 Rdot 很接近 0Tgo 会变成巨大的数值要加下限保护这里加一句Tgo 的分母保护不是可有可无的。我在调试时有一次没加结果某个工况下导弹飞到了一个瞬间接近速率接近于零的位置Tgo 直接跳过负载限幅偏置项算出来的加速度方向完全反了弹道直接打转。3.3 完整可运行代码下面是我调试通过的主程序所有参数都做了注释你可以直接抄下来改参数跑。%% 两级混合比例导引冲击时间控制制导律仿真 % 状态: x, y, vx, vy % 目标: 静止点目标 clear; clc; close all; %% 参数设置 V 250; % 导弹恒速 m/s target [5000; 0]; % 目标位置 Td 25; % 期望冲击时间 s N1 8; % 阶段1导航常数(航向修正) N2 5; % 阶段2导航常数(时间修正) kb 0.8; % 偏置比例增益 amax 80; % 法向过载上限 m/s^2 Rsw 3000; % 切换阈值: 剩余距离 m Rw 500; % 过渡带宽度 m %% 初始条件 theta0 25 * pi / 180; % 初始航向偏角 rad X0 [0; 0; V*cos(theta0); V*sin(theta0)]; %% 数值积分 opts odeset(RelTol, 1e-6, AbsTol, 1e-9, Events, impact_event); [t, X] ode45((t,X) guidance_rhs(t, X, target, V, Td, N1, N2, kb, amax, Rsw, Rw), ... [0 60], X0, opts); %% 结果后处理 x X(:,1); y X(:,2); R_t sqrt((target(1)-x).^2 (target(2)-y).^2); t_impact t(end); fprintf(期望冲击时间: %.2f s\n, Td); fprintf(实际命中时间: %.2f s\n, t_impact); fprintf(冲击时间误差: %.3f s\n, abs(Td - t_impact)); fprintf(脱靶量 : %.3f m\n, R_t(end)); figure; plot(x, y, LineWidth, 1.5); hold on; plot(target(1), target(2), rp, MarkerSize, 15, LineWidth, 1.5); axis equal; grid on; xlabel(x (m)); ylabel(y (m)); title(两级混合比例导引弹道轨迹);%% 制导与动力学函数 function dX guidance_rhs(t, X, target, V, Td, N1, N2, kb, amax, Rsw, Rw) x X(1); y X(2); vx X(3); vy X(4); theta atan2(vy, vx); rx target(1) - x; ry target(2) - y; R sqrt(rx^2 ry^2); q atan2(ry, rx); lambda_dot (rx*vy - ry*vx) / R^2; eta q - theta; Rdot -(rx*vx ry*vy) / R; if Rdot 1e-3 Rdot 1e-3; % 接近速率下限保护 end Tgo R / Rdot; e_t (Td - t) - Tgo; % 两级切换权重 w min(1, max(0, (Rsw - R) / Rw)); % 比例导引项与偏置项 a_png1 N1 * V * lambda_dot; a_png2 N2 * V * lambda_dot; a_bias kb * V * e_t / Tgo; % 末端死区: 时间误差足够小时关闭偏置, 交给比例导引收尾 if abs(e_t) 0.1 a_bias 0; end % 混合加速度指令 a_cmd (1 - w) * a_png1 w * (a_png2 a_bias); % 过载限幅 a_cmd max(-amax, min(amax, a_cmd)); % 动力学更新 dX zeros(4,1); dX(1) vx; dX(2) vy; dX(3) -a_cmd * sin(theta); dX(4) a_cmd * cos(theta); end function [value, isterminal, direction] impact_event(t, X, target) R sqrt((target(1)-X(1))^2 (target(2)-X(2))^2); value R - 0.1; % 脱靶量阈值 0.1 m isterminal 1; direction -1; end代码里三个细节再强调一遍。第一切换权重 w 的公式同时处理了切换和平滑两个动作R 大于 Rsw 时 w 为 0纯一级R 小于 Rsw - Rw 时 w 为 1完全进入二级混合中间线性过渡。所以不需要额外写 if 分支。第二末端死区 abs(e_t) 0.1 时直接把偏置清零。这个非常关键否则最后 0.2 秒 Tgo 很小偏置项会提供一个很大的加速度脉冲导弹会在目标附近抖动。第三事件函数里的 direction -1 表示只在距离从大往小经过阈值时触发防止导弹如果意外飞过目标从另一侧再回来时重复触发事件。3.4 后处理脚本看什么仿真跑完后除了画轨迹我强烈建议额外画三条曲线时间误差 e_t 随时间的变化、法向加速度 a_cmd 随时间的变化、剩余时间 Tgo 与期望剩余时间的对比。时间误差曲线能直观看出两级切换的时机第一级内 e_t 基本不变或缓慢变化因为偏置项还没介入第二级开始后 e_t 快速收敛到 0 附近。加速度曲线能看出切换那一刻是否平滑以及末端有没有过载尖峰。Tgo 对比曲线则能看出估计值在末端的行为如果末段 Tgo 抖动多半是 Tgo 估计出了问题。4. 仿真结果与时间窗口Td能设多大、参数有多敏感4.1 一组基准工况的实测结果我固定的基准参数是V 250 m/s目标在 [5000, 0]初始航向偏角 25°N1 8N2 5kb 0.8amax 80 m/s²Rsw 3000 mRw 500 m。这个初始条件下纯比例导引自由飞行命中时间大约在 22 秒左右。25 秒的期望时间相当于要求导弹晚到约 3 秒。仿真结果是实际命中 25.04 秒时间误差约 0.04 秒脱靶量 0.06 米。阶段一加速度峰值约 26 m/s²阶段二偏置介入后的加速度明显平稳末端 1 秒内有一个小的过载凸起但被限幅挡在 80 m/s² 以内。这个结果说明一件事只要 Td 选在合理窗口内两级混合结构能够把命中时刻精度做到亚秒甚至更小级别。你不需要末端去猛踩刹车或者绕大圈路径修正的过程被分散到了整个第二级飞行段。4.2 时间误差的收敛规律看时间误差曲线的话第一级基本保持初始误差缓慢变化。我的工况里初始 e_t 大约在 2.5 秒左右前 6 秒内几乎没动。第二级偏置介入后e_t 在剩余大约 8 秒飞行时间中逐渐收敛到 0.1 秒以内收敛过程没有明显超调。有个容易被忽略的细节第一级虽然没有偏置但 e_t 也在缓慢变化因为导弹航向在修正实际路径长度在变化Tgo 也不是一个固定值。这意味着你很难靠第一级结束时 e_t 还剩下多少来预判第二级需要的修正量所以偏置增益按估计值现场调节是必须的不能做成开环。4.3 期望时间 Td 能设多大时间窗口的真实边界这是整个参数里最值得关注的部分。我扫了一组 Td 的取值结果如下Td (s)实际命中时间 (s)时间误差 (s)最大过载 (m/s²)结果18——80饱和脱靶2020.830.8380饱和接近命中但精度差2323.060.0661命中2525.040.0458命中2828.130.1374命中但误差增大30——80饱和弹道打转脱靶结论很清楚Td 存在一个可行窗口。窗口下限大约是自由飞行时间附近低于下限导弹需要抄一条物理上做不到的近路偏置项会一直往一个方向猛打最终过载饱和、脱靶。窗口上限大约高于自由飞行时间 6~7 秒再往上要求绕太远的路同样会顶限幅。如果你把 Td 设得特别激进比如比自由飞行时间早 2 秒以上偏置项的方向就会强迫导弹切弯。这时候 Tgo 估计里的前置角误差会被显著放大偏置方向可能出错弹道就开始打转。我在 Td30 秒的工况里见过完整的绕圈现象导弹绕着一个大圈转时间误差完全失控。这个表的数值是我的参数组合下的结果你换了初始航向角或 amax 后数值会变但规律不变。调参的第一步永远是先跑一版纯 PNG 得到自由飞行时间然后在这个时间的基础上向后取 Td。4.4 参数敏感性kb 和 amax 的影响kb 是最需要小心整定的参数。太大偏置项过猛时间误差会来回震荡末段经常顶限幅太小时间误差收敛太慢到命中时刻也没修正完。我试过从 0.2 到 1.5 扫 kb0.8 附近是最稳的区间。如果 Td 离自由飞行时间远kb 要适当调小一点给偏置项留出余量。amax 决定了这个制导律能做到多少 Td 余量。过载上限越大可行时间窗口越宽。80 m/s² 大约 8g在这个仿真里已经够用。如果你实际平台只有 3g 的过载Td 窗口会窄一半响应也迟钝很多。5. 踩坑记录切换瞬态、Tgo估计失真与几个关键处理5.1 切换瞬态从阶跃切到斜坡过渡第一次跑通代码时w 是阶跃切的加速度曲线在切换点有明显折点弹道轨迹上也能看到一个折角。时间误差在切换后立刻抖了 0.2 秒然后才重新收敛。原因很简单偏置项突然从无到有相当于系统输入端加了一个阶跃扰动。这不是制导律本身的问题是执行层面的问题。加了一个 500 米过渡带之后折点消失时间误差收敛也顺了。这个经验同样适用于实际飞行控制。就算你在数值仿真里用阶跃切换成功了真实系统的执行机构也受不了这种指令突变工程上必然要做斜坡或平滑。5.2 Tgo估计在高曲率下的失真问题Tgo R / Rdot 这个估计在大前置角、高曲率弹道下会失真。Rdot 是当前瞬间的接近速率它只反映这一刻的速度几何不反映整条未来弹道的长度。如果导弹正在进行大过载转弯速度方向还在大幅变化那么基于当前 Rdot 算出的 Tgo 会和真实剩余时间差不少。我在 Td 试到 28 秒时遇到过一个问题e_t 显示误差不大但实际快到目标时竟然晚了 0.5 秒。回头看数据是偏置项在中段一直在根据失真的 Tgo 输出错误方向的小幅修正导致时间误差没有在应该收敛的阶段收敛。处理办法有两个。第一把 Tgo 估计改成含前置角的修正形式Tgo_est R / (V·cosη)其中 η 是速度方向与视线方向的夹角。这个形式在中小前置角下比 R/Rdot 稳。如果还想更精细可以加二阶项R/V·(1 η²/2)。实际测试中二阶修正足够用了再高阶反而对噪声敏感。第二在程序里对前置角做一个监控当 |η| 超过 45° 时说明弹道偏离目标方向太远Tgo 估计的可信度很低。此时要么把期望 Td 调回安全窗口要么强制加大 Rsw 让时间修正提前介入避免把问题拖到末端。5.3 末端死区一个绝对值 0.1 秒的生死线末端死区这行代码看上去不起眼实际上是最容易救回一个本来会脱靶工况的设置。Tgo 趋近于零时偏置项 kb·V·e_t / Tgo 的增益趋向无穷。就算时间误差已经只有 0.05 秒这个偏置项也能输出几十 m/s² 的加速度。此时目标几乎就在眼前法向加速度只会让导弹绕着目标画圈而不是缩小距离。死区的逻辑是时间误差已经小到可以接受的范围了就不再需要偏置项把收尾工作全部交给比例导引。比例导引本身具备脱靶量收敛能力最后 0.1 秒内足够把导弹拉回目标。我实测过去掉这行死区代码后好几组本来能命中的参数直接变成脱靶弹道末端会出现螺旋状抖动。这是所有冲击时间控制制导律都要面对的问题不是我这个方案独有的。5.4 从静止目标到运动目标、从单弹到多弹协同这套两级结构的扩展性还不错。目标运动时只需要把 Tgo 估计改成相对运动版本切换阈值继续用相对距离。多弹齐射时每枚导弹共用同一个期望冲击时间 Td各自独立运行两级梯度导引只要每枚导弹的 Td 都落在自己的可行窗口内就能实现同时到达。我自己用这套框架搭过一个三弹协同的仿真末段时间差在 0.1 秒以内。扩展到运动目标时有个新坑Tgo -R/Rdot 在运动目标场景下需要更频繁地更新因为相对几何变化快另外目标机动会直接改变 Tgo此时单靠比例项已经不够往往要在这个框架上再加一层目标加速度前馈。这部分我还在做等跑通之后单独写一篇补充。最后分享一个调参的小技巧不要一开始就盯着完整弹道看。先把 Td 设成自由飞行时间用纯 PNG 跑一版得到基准然后固定 kb 0.5、wd 过渡带取 300 米扫描 Td 从高 1 秒到高 8 秒记录每组参数的收敛情况画出时间窗口表。窗口摸清了再回头精调 kb 和 Rsw。按这个顺序来整个调试过程能省掉大半的试错时间。 
长河君 · 2026/9/30 9:28:00 · 阅读 1.2k 两级混合比例导引冲击时间控制制导律设计与Matlab仿真
做这个课题的第一周我基本都在怀疑人生。比例导引PNG被写进那么多教材不是没道理的——视线角速率乘一个导航常数导弹就能沿着一条漂亮的碰撞三角形轨迹飞向目标。但导师一句话把我问住了PNG能保证导弹在第25秒命中吗我愣住了。这就是冲击时间控制制导律要解决的问题能不能让飞行器不只在空间上收敛到目标还在时间上精确命中指定时刻。后来我基于混合比例导引设计了一款两级冲击时间控制制导律用Matlab把完整仿真跑通。从推导思路到代码细节再到参数整定和几个容易翻车的坑这篇文章一次说清楚。先给结论这套方案的本质是在比例导引加速度上叠加一个时间误差偏置项并通过两级策略控制偏置项的介入时机。第一级用纯比例导引快速把航向角压到碰撞三角形附近第二级再让时间偏置项逐步介入精确修正剩余飞行时间。实测下来在期望冲击时间比自由飞行时间晚3秒左右的工况下命中时刻误差可以控制在0.05秒以内脱靶量小于0.1米。如果你正在做齐射协同、多弹同时到达相关的制导律仿真或者只想搞清楚冲击时间控制到底怎么落地这篇应该能帮到你。1. 冲击时间控制到底在控制什么从PNG的盲区到两级设计的动机1.1 先把问题用数学写清楚目标静止导弹以恒定速度 V 飞行期望命中时刻为 Td。定义两个量实际剩余飞行时间估计值Tgo期望剩余飞行时间Td - t两者之差就是时间误差e_t (Td - t) - Tgo控制目标非常直白让 e_t 收敛到 0并且让相对距离 R 同时收敛到 0。换句话说既要命中又要在指定时刻命中。剩余飞行时间的估计是绕不开的第一步。最朴素的方法是用当前距离除以速度Tgo R / V。这个公式对大前置角、大过载机动的情况误差很大因为导弹并不是沿视线直线飞行。工程上更常用的是基于接近速率的估计Tgo -R / Rdot其中 Rdot -(rx·vx ry·vy) / R表示相对距离的变化率。这个式子把当前速度方向的前置角影响考虑进去了在导弹已经基本对准目标时非常准。缺点是在接近速率趋近于零比如垂直飞向目标时分母会出问题仿真时要做下限保护我后面代码里会给处理办法。1.2 PNG为什么解决不了准时命中这件事比例导引的加速度指令是 a N·V·λ̇N 是导航常数。它保证的是脱靶量收敛只要 N 2初始条件不极端导弹最终会进入碰撞三角形零控脱靶量趋近于零。但PNG没有任何一个参数是时间误差的显式通道。有人可能会说N 大一点导弹转弯猛一点飞行时间不就短了确实会变但这是隐式影响不是可控的。PNG的N只能改变收敛速度不能精确对准某个具体时刻。你想要导弹在第25.0秒命中PNG给不了你这种精度。想精确控制命中时刻必须在加速度指令里加一个专属于时间误差的通道——这就是偏置项存在的意义。1.3 为什么必须做成两级而不是直接叠加偏置直觉上最简单的方式是一开始就把偏置项加上让时间误差从第一秒开始修正。但实际仿真跑下来你会发现这条路很难走通。原因有两个。第一制导初期航向误差通常很大视线角速率 λ̇ 也大PNG项本身就在激烈操舵。此时叠加时间修正偏置相当于两个控制器争夺同一个执行机构。弹道会变得极其绕法向过载频繁顶到上限时间误差不但没有收敛反而可能被越带越大。第二越靠近目标Tgo越小偏置项里那个 V/Tgo 的增益会急剧放大。如果偏置从一开始就满负荷工作末端大概率出现过载饱和导致脱靶。所以工程上必须把制导过程拆成两段第一段只负责航向收敛把导弹带入一个视线角速率已经很小、弹道几何接近稳定的状态第二段再让时间修正偏置逐步介入。这就是两级的由来。这个思路的本质是解耦——先把空间问题解决个大概再用剩余的时间专门处理时间约束。1.4 混合比例导引的混合到底指什么很多论文里把这种结构叫作混合比例导引其实混合指的是加速度指令由两部分组成——比例导引项加时间误差偏置项。它不是两种独立制导律的切换而是同一个加速度指令里两项的混合。两级实现则体现为偏置项介入权重的变化第一级权重为0第二级权重从0平滑过渡到1。这么设计的好处是比例导引项始终在保证了命中几何的收敛性偏置项只在需要的时候介入避免了早期耦合和末端爆炸。后面仿真会证明这个结构比全程单级偏置稳定得多。2. 制导律构造加速度形式、偏置项设计与切换逻辑2.1 加速度指令的完整结构我采用的加速度指令形式如下a_cmd N·V·λ̇ w · kb · V/Tgo · e_t其中N·V·λ̇ 是比例导引项N 在第一级用 N1第二级用 N2e_t (Td - t) - Tgo时间误差kb 是偏置比例增益无量纲需要整定w 是两级切换权重取值范围 0 到 1整个式子看着简单但每一项都有讲究。比例导引项负责命中偏置项负责准时权重 w 负责什么时候开始准时。2.2 偏置项为什么要写成 kb·V/Tgo·e_t先说量纲V 单位是 m/se_t 单位是 sTgo 单位是 s乘完是 m/s²正好是加速度单位。这说明这个形式在量纲上是自洽的。再说物理直觉。法向加速度改变的是弹道曲率曲率一变导弹实际飞行的路径长度就变了剩余飞行时间 Tgo 自然跟着变。偏置项的增益 V/Tgo 意味着什么越接近目标Tgo 越小同样的时间误差需要的法向加速度越大。这符合实际你离目标很远时轻轻偏一下航线路径长度就能差出好几秒等你快到了才发现时间差了 0.5 秒想靠微调路径来弥补那必须大幅改变曲率才行。增益后面乘的 e_t 相当于一个比例控制器。e_t 为正说明实际估计剩余时间比期望剩余时间短导弹会早到偏置项就让导弹往外飘一点绕一点路e_t 为负说明会晚到偏置项就让导弹尽量切近路把路径缩短。为什么不用 PID 结构我一开始也试过加积分项但后来发现比例就够了。因为 Tgo 本身是个不断变化的量积分容易引入严重的滞后和超调尤其在末端会顶限幅。这个制导问题本质上是时变的比例项配合限幅和死区已经能解决大部分场景。2.3 切换逻辑怎么定我为什么用剩余距离阈值两级切换条件有几种做法按剩余距离切换当 R Rsw 时切到第二级按时间切换当 t t_sw 时切换按时间误差大小切换当 |e_t| e_sw 时切换我最终选了第一种Rsw 取初始距离的 50%~70%。主要原因是几何直观、好调参。初始距离 5000 米Rsw 取 3000 米意味着导弹先飞 2000 米左右做航向修正进入相对稳定的追击状态后再开始修时间。按时间切换需要事先知道比较靠谱的 t_sw但 t_sw 本身就跟弹道有关容易先有鸡还是先有蛋。按时间误差切换虽然概念上挺合理但如果在 e_t 很大的情况下就切进去偏置项一上来就是大幅值同样容易顶限幅。所以我用剩余距离做主切换条件。切换不能是阶跃式的。如果 w 直接从 0 跳到 1加速度指令会出现一个明显跳变弹道上能看见一个折点末端时间误差还会跟着抖一下。解决办法是加一个过渡带w 通过剩余距离的线性插值来变化。w clamp((Rsw - R) / Rw, 0, 1)比如 Rw 取 500 米那么从 R 3000 米到 R 2500 米这 500 米范围内w 从 0 线性增长到 1。这段过渡让偏置项温和地介入系统实测弹道和过载曲线都平滑很多。3. Matlab仿真实现状态方程、Tgo在线估计与完整代码3.1 仿真用的状态方程我用的状态变量是 X [x; y; vx; vy]目标静止导弹恒速 V。制导律输出的是法向加速度 a_cmd它改变的是速度方向角 θ而不是速度大小。速度方向角的动力学是 θ̇ a_cmd / V。把直角坐标下的速度分量展开vx V·cosθ vy V·sinθ求导就得到v̇x -a_cmd·sinθ v̇y a_cmd·cosθ这个形式适合直接用 ode45 数值积分。状态方程不难关键是每一步都要实时计算视线角速率、剩余距离、接近速率、Tgo 和时间误差再把制导指令算出来。3.2 容易出错的辅助量计算仿真循环里几个量要算对顺序也不能乱相对距离rx xt - xry yt - yR sqrt(rx² ry²)视线角速率λ̇ (rx·vy - ry·vx) / R²。注意分子别写反写反了导引项符号就错了导弹会往外飞而不是往目标飞接近速率Rdot -(rx·vx ry·vy) / R。这个量正常是正的表示距离在缩小剩余时间Tgo R / Rdot。如果 Rdot 很接近 0Tgo 会变成巨大的数值要加下限保护这里加一句Tgo 的分母保护不是可有可无的。我在调试时有一次没加结果某个工况下导弹飞到了一个瞬间接近速率接近于零的位置Tgo 直接跳过负载限幅偏置项算出来的加速度方向完全反了弹道直接打转。3.3 完整可运行代码下面是我调试通过的主程序所有参数都做了注释你可以直接抄下来改参数跑。%% 两级混合比例导引冲击时间控制制导律仿真 % 状态: x, y, vx, vy % 目标: 静止点目标 clear; clc; close all; %% 参数设置 V 250; % 导弹恒速 m/s target [5000; 0]; % 目标位置 Td 25; % 期望冲击时间 s N1 8; % 阶段1导航常数(航向修正) N2 5; % 阶段2导航常数(时间修正) kb 0.8; % 偏置比例增益 amax 80; % 法向过载上限 m/s^2 Rsw 3000; % 切换阈值: 剩余距离 m Rw 500; % 过渡带宽度 m %% 初始条件 theta0 25 * pi / 180; % 初始航向偏角 rad X0 [0; 0; V*cos(theta0); V*sin(theta0)]; %% 数值积分 opts odeset(RelTol, 1e-6, AbsTol, 1e-9, Events, impact_event); [t, X] ode45((t,X) guidance_rhs(t, X, target, V, Td, N1, N2, kb, amax, Rsw, Rw), ... [0 60], X0, opts); %% 结果后处理 x X(:,1); y X(:,2); R_t sqrt((target(1)-x).^2 (target(2)-y).^2); t_impact t(end); fprintf(期望冲击时间: %.2f s\n, Td); fprintf(实际命中时间: %.2f s\n, t_impact); fprintf(冲击时间误差: %.3f s\n, abs(Td - t_impact)); fprintf(脱靶量 : %.3f m\n, R_t(end)); figure; plot(x, y, LineWidth, 1.5); hold on; plot(target(1), target(2), rp, MarkerSize, 15, LineWidth, 1.5); axis equal; grid on; xlabel(x (m)); ylabel(y (m)); title(两级混合比例导引弹道轨迹);%% 制导与动力学函数 function dX guidance_rhs(t, X, target, V, Td, N1, N2, kb, amax, Rsw, Rw) x X(1); y X(2); vx X(3); vy X(4); theta atan2(vy, vx); rx target(1) - x; ry target(2) - y; R sqrt(rx^2 ry^2); q atan2(ry, rx); lambda_dot (rx*vy - ry*vx) / R^2; eta q - theta; Rdot -(rx*vx ry*vy) / R; if Rdot 1e-3 Rdot 1e-3; % 接近速率下限保护 end Tgo R / Rdot; e_t (Td - t) - Tgo; % 两级切换权重 w min(1, max(0, (Rsw - R) / Rw)); % 比例导引项与偏置项 a_png1 N1 * V * lambda_dot; a_png2 N2 * V * lambda_dot; a_bias kb * V * e_t / Tgo; % 末端死区: 时间误差足够小时关闭偏置, 交给比例导引收尾 if abs(e_t) 0.1 a_bias 0; end % 混合加速度指令 a_cmd (1 - w) * a_png1 w * (a_png2 a_bias); % 过载限幅 a_cmd max(-amax, min(amax, a_cmd)); % 动力学更新 dX zeros(4,1); dX(1) vx; dX(2) vy; dX(3) -a_cmd * sin(theta); dX(4) a_cmd * cos(theta); end function [value, isterminal, direction] impact_event(t, X, target) R sqrt((target(1)-X(1))^2 (target(2)-X(2))^2); value R - 0.1; % 脱靶量阈值 0.1 m isterminal 1; direction -1; end代码里三个细节再强调一遍。第一切换权重 w 的公式同时处理了切换和平滑两个动作R 大于 Rsw 时 w 为 0纯一级R 小于 Rsw - Rw 时 w 为 1完全进入二级混合中间线性过渡。所以不需要额外写 if 分支。第二末端死区 abs(e_t) 0.1 时直接把偏置清零。这个非常关键否则最后 0.2 秒 Tgo 很小偏置项会提供一个很大的加速度脉冲导弹会在目标附近抖动。第三事件函数里的 direction -1 表示只在距离从大往小经过阈值时触发防止导弹如果意外飞过目标从另一侧再回来时重复触发事件。3.4 后处理脚本看什么仿真跑完后除了画轨迹我强烈建议额外画三条曲线时间误差 e_t 随时间的变化、法向加速度 a_cmd 随时间的变化、剩余时间 Tgo 与期望剩余时间的对比。时间误差曲线能直观看出两级切换的时机第一级内 e_t 基本不变或缓慢变化因为偏置项还没介入第二级开始后 e_t 快速收敛到 0 附近。加速度曲线能看出切换那一刻是否平滑以及末端有没有过载尖峰。Tgo 对比曲线则能看出估计值在末端的行为如果末段 Tgo 抖动多半是 Tgo 估计出了问题。4. 仿真结果与时间窗口Td能设多大、参数有多敏感4.1 一组基准工况的实测结果我固定的基准参数是V 250 m/s目标在 [5000, 0]初始航向偏角 25°N1 8N2 5kb 0.8amax 80 m/s²Rsw 3000 mRw 500 m。这个初始条件下纯比例导引自由飞行命中时间大约在 22 秒左右。25 秒的期望时间相当于要求导弹晚到约 3 秒。仿真结果是实际命中 25.04 秒时间误差约 0.04 秒脱靶量 0.06 米。阶段一加速度峰值约 26 m/s²阶段二偏置介入后的加速度明显平稳末端 1 秒内有一个小的过载凸起但被限幅挡在 80 m/s² 以内。这个结果说明一件事只要 Td 选在合理窗口内两级混合结构能够把命中时刻精度做到亚秒甚至更小级别。你不需要末端去猛踩刹车或者绕大圈路径修正的过程被分散到了整个第二级飞行段。4.2 时间误差的收敛规律看时间误差曲线的话第一级基本保持初始误差缓慢变化。我的工况里初始 e_t 大约在 2.5 秒左右前 6 秒内几乎没动。第二级偏置介入后e_t 在剩余大约 8 秒飞行时间中逐渐收敛到 0.1 秒以内收敛过程没有明显超调。有个容易被忽略的细节第一级虽然没有偏置但 e_t 也在缓慢变化因为导弹航向在修正实际路径长度在变化Tgo 也不是一个固定值。这意味着你很难靠第一级结束时 e_t 还剩下多少来预判第二级需要的修正量所以偏置增益按估计值现场调节是必须的不能做成开环。4.3 期望时间 Td 能设多大时间窗口的真实边界这是整个参数里最值得关注的部分。我扫了一组 Td 的取值结果如下Td (s)实际命中时间 (s)时间误差 (s)最大过载 (m/s²)结果18——80饱和脱靶2020.830.8380饱和接近命中但精度差2323.060.0661命中2525.040.0458命中2828.130.1374命中但误差增大30——80饱和弹道打转脱靶结论很清楚Td 存在一个可行窗口。窗口下限大约是自由飞行时间附近低于下限导弹需要抄一条物理上做不到的近路偏置项会一直往一个方向猛打最终过载饱和、脱靶。窗口上限大约高于自由飞行时间 6~7 秒再往上要求绕太远的路同样会顶限幅。如果你把 Td 设得特别激进比如比自由飞行时间早 2 秒以上偏置项的方向就会强迫导弹切弯。这时候 Tgo 估计里的前置角误差会被显著放大偏置方向可能出错弹道就开始打转。我在 Td30 秒的工况里见过完整的绕圈现象导弹绕着一个大圈转时间误差完全失控。这个表的数值是我的参数组合下的结果你换了初始航向角或 amax 后数值会变但规律不变。调参的第一步永远是先跑一版纯 PNG 得到自由飞行时间然后在这个时间的基础上向后取 Td。4.4 参数敏感性kb 和 amax 的影响kb 是最需要小心整定的参数。太大偏置项过猛时间误差会来回震荡末段经常顶限幅太小时间误差收敛太慢到命中时刻也没修正完。我试过从 0.2 到 1.5 扫 kb0.8 附近是最稳的区间。如果 Td 离自由飞行时间远kb 要适当调小一点给偏置项留出余量。amax 决定了这个制导律能做到多少 Td 余量。过载上限越大可行时间窗口越宽。80 m/s² 大约 8g在这个仿真里已经够用。如果你实际平台只有 3g 的过载Td 窗口会窄一半响应也迟钝很多。5. 踩坑记录切换瞬态、Tgo估计失真与几个关键处理5.1 切换瞬态从阶跃切到斜坡过渡第一次跑通代码时w 是阶跃切的加速度曲线在切换点有明显折点弹道轨迹上也能看到一个折角。时间误差在切换后立刻抖了 0.2 秒然后才重新收敛。原因很简单偏置项突然从无到有相当于系统输入端加了一个阶跃扰动。这不是制导律本身的问题是执行层面的问题。加了一个 500 米过渡带之后折点消失时间误差收敛也顺了。这个经验同样适用于实际飞行控制。就算你在数值仿真里用阶跃切换成功了真实系统的执行机构也受不了这种指令突变工程上必然要做斜坡或平滑。5.2 Tgo估计在高曲率下的失真问题Tgo R / Rdot 这个估计在大前置角、高曲率弹道下会失真。Rdot 是当前瞬间的接近速率它只反映这一刻的速度几何不反映整条未来弹道的长度。如果导弹正在进行大过载转弯速度方向还在大幅变化那么基于当前 Rdot 算出的 Tgo 会和真实剩余时间差不少。我在 Td 试到 28 秒时遇到过一个问题e_t 显示误差不大但实际快到目标时竟然晚了 0.5 秒。回头看数据是偏置项在中段一直在根据失真的 Tgo 输出错误方向的小幅修正导致时间误差没有在应该收敛的阶段收敛。处理办法有两个。第一把 Tgo 估计改成含前置角的修正形式Tgo_est R / (V·cosη)其中 η 是速度方向与视线方向的夹角。这个形式在中小前置角下比 R/Rdot 稳。如果还想更精细可以加二阶项R/V·(1 η²/2)。实际测试中二阶修正足够用了再高阶反而对噪声敏感。第二在程序里对前置角做一个监控当 |η| 超过 45° 时说明弹道偏离目标方向太远Tgo 估计的可信度很低。此时要么把期望 Td 调回安全窗口要么强制加大 Rsw 让时间修正提前介入避免把问题拖到末端。5.3 末端死区一个绝对值 0.1 秒的生死线末端死区这行代码看上去不起眼实际上是最容易救回一个本来会脱靶工况的设置。Tgo 趋近于零时偏置项 kb·V·e_t / Tgo 的增益趋向无穷。就算时间误差已经只有 0.05 秒这个偏置项也能输出几十 m/s² 的加速度。此时目标几乎就在眼前法向加速度只会让导弹绕着目标画圈而不是缩小距离。死区的逻辑是时间误差已经小到可以接受的范围了就不再需要偏置项把收尾工作全部交给比例导引。比例导引本身具备脱靶量收敛能力最后 0.1 秒内足够把导弹拉回目标。我实测过去掉这行死区代码后好几组本来能命中的参数直接变成脱靶弹道末端会出现螺旋状抖动。这是所有冲击时间控制制导律都要面对的问题不是我这个方案独有的。5.4 从静止目标到运动目标、从单弹到多弹协同这套两级结构的扩展性还不错。目标运动时只需要把 Tgo 估计改成相对运动版本切换阈值继续用相对距离。多弹齐射时每枚导弹共用同一个期望冲击时间 Td各自独立运行两级梯度导引只要每枚导弹的 Td 都落在自己的可行窗口内就能实现同时到达。我自己用这套框架搭过一个三弹协同的仿真末段时间差在 0.1 秒以内。扩展到运动目标时有个新坑Tgo -R/Rdot 在运动目标场景下需要更频繁地更新因为相对几何变化快另外目标机动会直接改变 Tgo此时单靠比例项已经不够往往要在这个框架上再加一层目标加速度前馈。这部分我还在做等跑通之后单独写一篇补充。最后分享一个调参的小技巧不要一开始就盯着完整弹道看。先把 Td 设成自由飞行时间用纯 PNG 跑一版得到基准然后固定 kb 0.5、wd 过渡带取 300 米扫描 Td 从高 1 秒到高 8 秒记录每组参数的收敛情况画出时间窗口表。窗口摸清了再回头精调 kb 和 Rsw。按这个顺序来整个调试过程能省掉大半的试错时间。