做导弹制导控制方向的人大概率都经历过这个场景比例导引在仿真里打靶怎么打怎么中但任务书里突然多了一句话——以指定落角命中目标。这时候十有八九要重新折腾制导律。我自己最开始试过偏置比例导引调了几轮参数换个初始条件就得重新修偏置项实在繁琐。后来把滑模制导律完整跑通用纯m代码在Matlab里实现了带落角约束的俯仰、偏航双通道制导模型固定目标和移动目标都能打收敛效果也很理想。这篇就把我从建模推导、m代码结构到调参踩坑的完整路径写出来。内容不是论文复述而是按实际工程习惯整理的实现笔记适合正在做制导律仿真、需要把落角约束落到具体代码里的同学参考也适合想搞清楚落角约束为什么能写成滑模面的人。1. 为什么落角约束这么关键命中只是及格线很多刚接触制导控制的人会有一个直觉制导律的目标就是让导弹飞向目标确保命中就行。但在大量实际任务里命中只是最基本的要求终端弹道角度往往才是决定任务成败的核心指标。1.1 实际任务中的落角需求落角约束在工程里有多普遍可以看几个典型场景。反装甲弹药要求比较大的落角通常希望终端弹道接近垂直方向也就是从顶部攻击装甲最薄弱的部位落角不够会导致战斗部无法发挥应有的毁伤效果。钻地类弹药更极端要求弹体以接近垂直的角度撞击地面才能保证钻深和引信触发时序。反舰导弹末段需要先降高再俯冲以大落角命中目标舰船甲板这样既可以利用重力加速提高命中速度也能有效规避近防系统的拦截窗口。对地攻击场景中导引头的视场和探测方向也决定了只有在特定角度命中成像导引头才能稳定锁定目标要害区域。这些需求放到制导律设计里就变成了一个明确的终端约束飞行末端的弹道倾角、弹道偏角需要被控制到指定值附近。也就是说制导律不但要让脱靶量足够小还要让终端角度误差满足指标。1.2 比例导引与偏置导引的先天不足传统比例导引Proportional NavigationPN的核心思想是让视线角速率趋于零。视线角速率归零后弹目视线方向不再变化导弹只要朝视线方向飞就一定能命中。这个逻辑很简单也很可靠但它只约束了视线方向完全没有约束终端时刻的弹道角度。相同初始条件下PN的终端落角完全由导航比N和初始几何关系决定设计人员没法预先指定。偏置比例导引是一种常见的补救方案在比例导引的基础上叠加一个随时间衰减的偏置项利用偏置项在末端改变弹道方向落到期望角度上。这个方法实现起来不复杂但实际用起来有个明显的问题偏置项的系数、衰减时序和终端角度关系是非线性的初始条件一变偏置参数就得重新整定。如果目标还有机动偏置比例导引的鲁棒性会更差。相比之下滑模制导律的优势在于终端约束可以直接写成滑模面控制目标从视线角速率为零变成视线角误差和视线角速率同时归零。滑模控制对参数摄动和外部干扰有天然的不敏感性在这种存在强非线性、模型不确定性的制导问题里特别适用。这也是这个m代码模型选择滑模制导律的根本原因。2. 滑模制导律的建模与公式推导把终端约束翻译成控制量写代码之前先把模型和公式理清楚。制导律不是拍脑袋写出来的控制率每一步推导都对应着代码里的一个计算模块。2.1 弹目相对运动模型与双通道解耦先从二维平面开始。定义弹目相对位置dx xt - xm dy yt - ym R sqrt(dx^2 dy^2) q atan2(dy, dx)其中xm、ym是导弹位置xt、yt是目标位置R是相对距离q是视线角。视线角速率的计算公式是q_dot (dx * (vty - vmy) - dy * (vtx - vmx)) / R^2其中vtx、vty是目标速度分量vmx、vmy是导弹速度分量。这个公式看着复杂实际上就是二维叉积除以距离平方几何意义是相对速度中垂直于视线方向的分量在单位距离上产生的角速度。代码里直接照这个写就可以了。三维问题怎么处理模型里做了工程上最常见的简化——把三维制导解耦成俯仰和偏航两个平面。纵向平面俯仰用视线高低角作为被控量侧向平面偏航用视线方位角作为被控量两个通道共用同一套滑模制导律结构只是坐标定义和角度基准不同。实际飞行控制里导弹的俯仰、偏航通道本来就有独立的自动驾驶仪这种解耦设计和工程实现是一致的。2.2 滑模面设计与趋近律选取这是整套代码最核心的部分。首先要把落角约束翻译成视线角约束。很多新手卡在这里落角是弹道倾角视线角是弹目连线角度两者根本不是一回事。这里的关键逻辑是当视线角被锁定在某个方向时导弹速度方向最终会趋向与视线方向一致否则视线角一定会变化。因此在终端时刻弹道倾角在理想情况下等于视线角。所以落角约束可以近似等价为期望视线角约束。定义状态误差x1 q - qd % 视线角误差 x2 q_dot % 视线角速率其中qd是期望视线角由期望落角换算得到。在这个m代码模型里直接取qd等于期望落角。滑模面取线性形式s x2 c * x1 q_dot c * (q - qd)当系统到达滑模面s0后有q_dot -c * (q - qd)这是一个一阶稳定系统视线角误差会指数收敛到零收敛速度由c决定。也就是说只要能把系统状态驱动到滑模面上终端视线角就等于期望值落角约束自然满足。趋近律选择指数趋近律s_dot -k * s - epsilon * sat(s / phi)这里用饱和函数sat(s/phi)而不是符号函数sign(s)。原因很直接符号函数在零点附近会产生高频切换仿真里表现为过载指令高频抖动实际工程里执行机构根本响应不了这种抖振。饱和函数在边界层内把切换项替换成线性项能大幅抑制抖振代价是收敛速度和鲁棒性略有下降这个代价在工程上完全可接受。2.3 从趋近律反解制导指令控制量的推导基于视线角的二阶动态方程。在简化模型中视线角加速度主要取决于两项相对距离变化率引起的几何项和法向过载项。视线角动态可以表示为q_ddot -2 * (R_dot / R) * q_dot - a_cmd / R其中R_dot是相对距离变化率接近目标时为负a_cmd是法向过载指令。对滑模面求导s_dot q_ddot c * q_dot把q_ddot代入并令s_dot等于趋近律整理后得到制导指令a_cmd -2 * R_dot * q_dot R * (c * q_dot k * s epsilon * sat(s / phi))这个公式就是滑模制导律核心函数的实现依据。前一项补偿距离变化率引起的视线转动后一项完成滑模面的趋近和维持。代码里按这个式子写就行如果坐标系正方向定义不同注意a_cmd的正负号可能要对调这是不同教材坐标习惯导致的正常差异。3. 纯m代码实现仿真主循环与核心函数拆解模型用的全部是m函数和m脚本不依赖Simulink好处是方便改写、方便移植也方便在代码里直接加断点调试。下面按主脚本、制导律函数、目标接口三层来拆解。3.1 主仿真脚本的骨架结构主脚本做的事情很常规设置仿真参数、初始化状态、进入循环、输出结果。但有几个细节对仿真结果影响很大需要在代码层面处理。% 主仿真脚本落角约束滑模制导律固定目标 / 匀速移动目标 clc; clear; close all; % 仿真参数 dt 0.001; % 固定步长单位秒 T_end 40; % 仿真时长 N round(T_end / dt) 1; t 0:dt:T_end; % 初始条件 xm0 0; ym0 0; % 导弹初始位置 Vm 300; % 导弹速度恒定常量m/s theta_m0 20 * pi / 180; % 初始弹道倾角 xt0 8000; yt0 0; % 目标初始位置 Vt 0; % 目标速度0表示固定目标 theta_t 0; % 目标运动方向 % 落角约束 theta_d -60 * pi / 180; % 期望落角负值表示向下 q_d theta_d; % 简化映射期望视线角 期望落角 % 制导律参数 param.c 2.5; % 滑模面系数 param.k 3; % 指数趋近速率 param.epsilon 0.2; % 鲁棒切换增益 param.phi 0.05; % 边界层厚度 param.a_max 15 * 9.8; % 最大过载指令限制 % 状态记录 xm_hist zeros(1, N); ym_hist zeros(1, N); xt_hist zeros(1, N); yt_hist zeros(1, N); theta_m_hist zeros(1, N); q_hist zeros(1, N); qdot_hist zeros(1, N); R_hist zeros(1, N); a_hist zeros(1, N);这里仿真步长固定为0.001秒后面会单独讲为什么固定步长比变步长更适合这种制导律仿真。3.2 滑模制导律核心函数的实现核心函数就是第二节推导公式的直接翻译。输入是弹目相对几何状态和滑模参数输出是过载指令。距离保护是必须加的否则末端距离趋近于零时视线角速率的计算会直接爆炸。function [a_cmd, s] sliding_guidance(R, R_dot, q, q_dot, q_d, param) % 滑模落角约束制导律 % 输入 % R 相对距离 % R_dot 相对距离变化率 % q 视线角 % q_dot 视线角速率 % q_d 期望视线角 % param 结构体c, k, epsilon, phi, a_max % 输出 % a_cmd 法向过载指令 % s 滑模面数值便于调试 c param.c; k param.k; epsilon param.epsilon; phi param.phi; a_max param.a_max; R max(R, 1e-3); % 距离保护防止除零 s q_dot c * (q - q_d); % 滑模面 u_s k * s epsilon * sat(s / phi); % 趋近律 % 由视线角二阶动态方程反解法向过载指令 a_cmd -2 * R_dot * q_dot R * (c * q_dot u_s); % 过载限幅模拟执行机构限制 a_cmd min(max(a_cmd, -a_max), a_max); end function y sat(x) y min(max(x, -1), 1); end函数里a_cmd的量纲取决于状态量的单位在米制单位下计算得到的是米每二次方秒也就是加速度量纲。实际使用中如果要换算成过载g数除以9.8就行。过载限幅放在制导律函数里面是因为不管换什么场景限幅都是必须的直接封装进去避免后续调用漏掉。3.3 仿真循环与运动学更新主循环里要做的事情包括计算相对几何、调用制导律、更新自动驾驶仪动态、更新导弹和目标运动状态。% 初始化 xm xm0; ym ym0; xt xt0; yt yt0; theta_m theta_m0; a_m 0; % 实际可用过载初始为零 vt_x Vt * cos(theta_t); vt_y Vt * sin(theta_t); for i 1:N-1 % 相对几何 dx xt - xm; dy yt - ym; R sqrt(dx^2 dy^2); q atan2(dy, dx); % 相对速度与视线角速率 vm_x Vm * cos(theta_m); vm_y Vm * sin(theta_m); R_dot (dx * (vt_x - vm_x) dy * (vt_y - vm_y)) / R; q_dot (dx * (vt_y - vm_y) - dy * (vt_x - vm_x)) / R^2; % 制导指令 [a_cmd, s] sliding_guidance(R, R_dot, q, q_dot, q_d, param); % 自动驾驶仪一阶惯性动态 tau 0.3; % 时间常数秒 a_m_dot (a_cmd - a_m) / tau; a_m a_m a_m_dot * dt; % 导弹运动学更新 theta_m theta_m (a_m / Vm) * dt; xm xm Vm * cos(theta_m) * dt; ym ym Vm * sin(theta_m) * dt; % 目标运动更新匀速直线 xt xt vt_x * dt; yt yt vt_y * dt; % 记录状态 xm_hist(i1) xm; ym_hist(i1) ym; xt_hist(i1) xt; yt_hist(i1) yt; theta_m_hist(i1) theta_m; q_hist(i1) q; qdot_hist(i1) q_dot; R_hist(i1) R; a_hist(i1) a_m; end自动驾驶仪部分用一阶惯性环节近似这是仿真和真实设备差距的主要来源之一。实际导弹的过载响应有延迟仿真里如果不加这个延迟制导律会显得特别理想一旦接入真实模型性能会明显下降。弹道倾角的更新用theta_m_dot a_m / Vm物理意义是法向过载等于速度乘以弹道倾角变化率。这个关系只在速度恒定、过载垂直于速度方向时严格成立简化模型里这样用没问题。3.4 移动目标的接入方式移动目标在代码层面没有额外的复杂度只需要改目标速度和目标运动方向。上面的循环已经预留了vt_x和vt_y把Vt设为非零值就能模拟匀速直线运动的目标。如果需要更复杂的目标机动在循环里加目标加速度即可% 目标匀加速运动在循环内更新目标速度 ax 5; % 目标加速度m/s^2 ay 5; vt_x vt_x ax * dt; vt_y vt_y ay * dt;目标机动能力越强对制导律的鲁棒性挑战越大。滑模制导律在滑模面里天然包含了对目标加速度项的鲁棒性但增益epsilon要取够大才有意义后面参数整定部分会细说。4. 收敛效果验证与参数整定经验模型跑通之后最关心的问题是收敛效果到底怎么评价参数怎么调才能又快又稳这一节全是我实际调参过程中沉淀下来的经验。4.1 怎么评价收敛效果脱靶量、落角误差、过载曲线评价落角约束制导律单看脱靶量远远不够。三个指标需要一起看。脱靶量是弹目相对距离R在仿真过程中的最小值代码里可以直接用min(R_hist)得到。注意要在命中前截断否则末端接近后数值计算可能出问题。落角误差是终端弹道倾角与期望落角的差值。在简化模型里终端弹道倾角就是theta_m_hist的最后一个值期望落角是theta_d。落角误差计算为abs(theta_m(end) - theta_d)。这个指标直接反映落角约束的满足程度。过载曲线需要观察两个方面一是最大过载是否超过设定限幅如果长时间限幅说明控制量需求超出执行机构能力需要调整弹道规划或初始条件二是曲线是否高频抖动抖动意味着滑模面附近存在高频切换需要调大边界层或者降低epsilon。一组比较理想的评估结果是固定目标场景下脱靶量小于0.1m落角误差小于0.3度匀速移动目标场景下目标速度不超过导弹速度的五分之一脱靶量控制在0.5m以内落角误差控制在0.5度量级。这个水平在简化几何模型里已经算收敛得很好了。4.2 参数对收敛过程的影响规律滑模制导律有几个可调参数c、k、epsilon、phi。每个参数的影响都不一样调试时必须区分开。参数作用调大后的效果调小后的效果c滑模面误差收敛斜率视线角收敛加快但过载需求变大收敛变慢弹道平缓k指数趋近速率更快到达滑模面指令偏大到达滑模面变慢epsilon鲁棒切换增益抗干扰增强抖振加剧抗干扰减弱曲线平滑phi边界层厚度抖振明显减弱稳态误差增大精度提高抖振风险增大实际调试里最容易混淆的是k和epsilon。k管的是还有多快回到滑模面epsilon管的是在滑模面上能不能顶住干扰。两者看起来都是把状态拉回去但作用阶段不同。k太大初始段过载会冲得很高epsilon太大终端段过载会高频小幅波动。我的经验是先调c和k确定基本收敛形态再单独调epsilon解决末端抖振。4.3 我的调参顺序和实用建议调参顺序强烈建议从固定目标开始固定目标没有目标速度干扰问题能隔离得比较干净。第一步先固定c在23之间k在12之间epsilon取0.1phi取0.05跑一次看基本曲线。注意观察视线角是否单调趋向期望值如果出现明显震荡先把c降下来。第二步逐步加大k观察脱靶量和落角误差的变化。k加大后如果过载曲线出现尖峰说明k已经偏大回退到上一个可用值。第三步把epsilon从0.1往上加同时观察终端过载曲线。如果开始出现高频抖动就把epsilon降回去然后用phi来平滑phi在0.020.1之间比较合适。第四步切换到移动目标场景重新验证。移动目标场景下落角误差通常会变大优先考虑提高epsilon而不是k因为目标机动的本质是外部扰动正好是epsilon的作用范围。最后还要提醒一个容易踩的坑不要单独追求脱靶量或者落角误差其中一个指标两项要放在一起权衡。有时候把落角误差压到0.1度以内脱靶量反而会变大因为终端弹道被强行掰角度会导致过载需求剧增。工程上通常同时给定两个指标例如脱靶量1m且落角误差2度在满足约束的前提下让曲线足够平滑就够了。5. 从仿真到应用模型扩展与常见坑位排查这个m代码模型属于典型的原理验证级别从验证模型走向工程应用中间还有不少扩展工作要做也有好几个非常容易踩的坑。5.1 从质点模型到六自由度模型的扩展路径目前模型把导弹当作质点速度恒定法向过载用一阶惯性近似。真实制导回路远不止这些。扩展路径大体包括加入弹体姿态运动学方程把过载指令转换到舵偏角指令引入气动数据计算实际可用过载速度不再是常数需要加入发动机推力、重力、气动阻力模型导引头跟踪回路要单独建模因为真实的视线角、视线角速率是通过导引头测量得到的有测量噪声、有视场角限制。每一步扩展都可能暴露新问题但制导律设计层面的结构可以保持不变。我建议扩展时一个模块一个模块地加每加一个模块就重新检查一次脱靶量和落角误差避免多个误差源叠加在一起时根本说不清是谁导致的。5.2 仿真中几个容易爆雷的细节第一个坑是视线角速率在末端爆炸。弹目距离R接近零时R^2出现在分母上任何一点数值误差都会被放大到离谱的程度。我的习惯是给R加一个下限保护R小于1e-3就按1e-3算同时结合脱靶量判断命中时刻命中后及时终止仿真。第二个坑是符号函数带来的高频抖振。之前试过直接用sign函数结果过载曲线在滑模面两侧来回跳仿真步长稍微变一下就跳到另一个状态整个结果不可复现。换成sat函数并选择合适的边界层厚度后抖振基本消除结果也变得稳定可复现。第三个坑是不同积分方法导致结果差异巨大。用ode45这类变步长解算器在制导律切换频繁时步长会自动缩得很小仿真速度慢且结果和固定步长法差别很大。制导律仿真我更推荐固定步长积分步长取0.5ms到1ms这样和真实飞控代码的运行逻辑更接近也方便把算法直接移植到嵌入式环境。第四个坑是初始视线角和期望视线角相差过大。如果初始几何关系和期望落角差距很大过载指令一开始就会顶到限幅值。这不是算法问题是任务可行性问题需要预先判断几何条件是否支持落角约束。5.3 后续可以继续做的工作这个模型只是起点实际很值得继续做的工作包括把滑模面换成非奇异终端滑模让视线角误差在有限时间收敛收敛速度比指数收敛更快增加扩张状态观测器来估计目标加速度把目标机动当作系统扰动主动补偿掉降低对epsilon的依赖做蒙特卡洛打靶对初始条件误差、目标速度误差、测量噪声做数百次随机仿真统计脱靶量和落角误差的分布特性这是评价制导律工程可用性的重要手段。我在实际使用中发现滑模制导律对参数的容忍度比想象中高不少c和k在合理范围内变化都能收敛真正影响使用体验的反而是epsilon和边界层phi的搭配。我的习惯是先把epsilon取到0.2让系统响起来稳定后再逐步下调到0.05以下直到终端过载曲线没有明显抖动为止。另外仿真步长一定固定尽量不要和ode45混用否则你很难判断结果是算法的问题还是数值计算的问题。这套流程走下来落角约束制导律从建模到m代码实现就会变得非常顺手。
