简介：这份PDF文档面向学习导航制导与控制（GNC）的本科生、研究生及工程入门者，以MATLAB/Simulink为工具，解决导弹制导系统从理论建模到数字仿真实验的落地问题。资源包共1个PDF文件，约2.78MB，内容围绕Simulink导弹模型展开，依次讲解大气模型、六自由度动力学与运动学、自动驾驶仪设计、导引头追踪、弹目相对位置计算、制导计算机与引战系统，并给出比例导引、一般趋近律滑模制导、随机滑模变结构制导及H∞拦截制导律的实验设置与对比思路。目录结构按建模模块递进，便于对照搭建与复现。已有715人学习，适合希望把课堂概念转化为可运行仿真、理解制导律工程约束与模式切换的读者参考。

1. 从一份“跑不起来”的模型说起：这套 GNC 仿真方案到底解决什么

很多同学拿到导弹制导相关的课题时，第一反应是去翻控制理论教材，把比例导引、滑模控制的公式从头推一遍，推完发现还是不知道怎么在 Simulink 里搭出一个能跑通、能出弹道曲线的闭环模型。问题不在理论，而在于从“纸面方程”到“可仿真系统”之间缺了一层工程化的拆解：大气环境怎么建、气动系数怎么插值、自动驾驶仪增益怎么调度、导引头天线罩误差怎么加、制导模式怎么切换，这些环节任何一个没接上，模型就是一堆红线和代数环。

这套基于 MATLAB/Simulink 的 Missile Guidance 模型方案，解决的正是这个断层。它把 GNC（导航、制导与控制）系统拆成大气模型、弹体动力学与运动学、三回路自动驾驶仪、导引头跟踪回路、制导计算机状态机、引战系统六个可独立验证的子系统，再在纵向平面内串成一条从发射搜索到命中引爆的完整链路。适合两类人：一是做飞行力学、制导控制方向毕设或课设的学生，需要一套结构完整、能改参数、能出对比实验的仿真底稿；二是刚接触 GNC 系统建模的从业者，想找一个“麻雀虽小五脏俱全”的参考架构，把各模块的接口关系和信号流理清楚。下面按需求、设计、实现、避坑、验收的顺序，把这套方案拆开讲。

2. 总体方案设计：六个子系统与一条纵向仿真链路

2.1 为什么选纵向平面而不是六自由度全量模型

完整六自由度弹道仿真当然更“真”，但对毕设和课设周期来说，六自由度带来的坐标转换、欧拉角奇异、配平工作量会迅速吃掉大部分时间，而制导律本身的设计验证并不需要全量自由度。这套模型只在导弹纵向平面内讨论问题，把滚转和偏航通道冻结，保留俯仰通道的攻角、俯仰角速率、法向过载三个核心状态。这样做的代价是被拦截目标不做机动规避，结论只对纵向拦截有效；收益是模型规模可控，每个子系统的输入输出都能用示波器直接看清，调试时不会陷入“改了 A 模块、B 模块跟着漂”的泥潭。

我一般会建议学生先用这个纵向模型把制导律跑通、把参数调稳，再考虑往三自由度或六自由度扩展。顺序反了，很容易在坐标转换上耗掉两周，制导律一行没写。

2.2 六个子系统的职责划分与信号流

整个仿真链路按信号流可以分成三段：环境与弹体段、探测与制导段、执行与毁伤段。

这条链路的闭环点在于：制导计算机给出的过载指令进自动驾驶仪，自动驾驶仪驱动舵面改变弹体姿态，弹体姿态变化又改变弹目几何，导引头重新测量视线角速率。任何一个环节的延迟或饱和没处理好，闭环就会振荡甚至发散，这也是后面避坑章节要重点讲的地方。

2.3 仿真步长与更新频率的匹配

制导系统以 100 Hz 更新，导引头跟踪回路时间常数取 0.05 秒，估算器滤波器带宽设为自动驾驶仪带宽的一半。这几个数字不是随手填的，它们决定了仿真求解器的步长上限。通常的做法是：定步长求解器步长取制导更新周期的十分之一左右，也就是 1 ms 量级；如果自动驾驶仪内部有更快的速率回路，还要再往下压。步长给大了，舵面限幅和积分抗饱和的逻辑会被“跨过去”，现象是仿真能跑完但弹道明显失真；步长给小了，仿真时间成倍增加，调参阶段很难受。我一般先在 1 ms 定步长下把逻辑跑通，确认状态机切换和引信时序都对，再切到变步长做精度校核。

3. 弹体与环境建模：从大气公式到非线性气动系数

3.1 大气模型的两段式近似与参数计算

大气子系统采用国际标准大气的两段近似：海平面到 11 km 是对流层，温度随高度线性下降；11 km 到 20 km 是平流层下部，温度保持不变。给定高度后输出温度、声速、大气压力和密度，供气动系数计算使用。核心公式如下：

% 大气模型核心计算（两段式国际标准大气近似） % 输入: h 海拔高度 [m] % 输出: T 温度[K], rho 密度[kg/m^3], P 静压[N/m^2], a 声速[m/s] T0 = 288.15; % 海平面绝对温度 [K] rho0 = 1.225; % 海平面大气密度 [kg/m^3] P0 = 101325; % 海平面大气静压 [N/m^2] L = 0.0065; % 气温直减率 [K/m] R = 287.05; % 特征气体常数 [J/(kg·K)] g = 9.80665; % 重力加速度 [m/s^2] gamma = 1.4; % 比热比 if h <= 11000 T = T0 - L * h; P = P0 * (T / T0)^(g / (L * R)); rho = rho0 * (T / T0)^(g / (L * R) - 1); else T = T0 - L * 11000; % 平流层温度恒定 P11 = P0 * (T / T0)^(g / (L * R)); % 11km 处压力 P = P11 * exp(-g * (h - 11000) / (R * T)); rho = P / (R * T); end a = sqrt(gamma * R * T); % 声速

这段代码的关键在于指数项的写法：对流层用温度比的幂函数，平流层用等温指数衰减，两段在 11 km 处必须连续。调试时最常见的错误是直接把两段公式拼在一起却没做衔接校验，结果在 11 km 附近密度出现跳变，弹道曲线在对应高度上会有一个不自然的折点。验证方法很简单：单独搭一个 Atmosphere 测试模块，把高度从 0 扫到 20 km，画出四条曲线看是否光滑单调。

3.2 动力学与运动学方程的实现要点

弹体模型描述一种尾翼控制导弹，飞行速度 2 到 4 马赫，高度 3050 到 18290 米，典型迎角正负 20 度。核心是非线性刚体动态：气动力和力矩由攻角、马赫数的非线性函数系数产生，而不是线性化后的导数。俯仰通道的力矩方程和法向力方程大致是：

% 俯仰通道气动力与力矩（简化示意，系数为多项式逼近） % alpha: 攻角[rad], delta: 尾舵偏角[rad], M: 马赫数, q: 俯仰角速率[rad/s] % V: 速度[m/s], m: 质量, Iy: 俯仰转动惯量, S: 参考面积, d: 直径 % 非线性气动系数（三次多项式逼近，系数按马赫数分段） Cm_alpha = a1*alpha + a3*alpha^3; Cm_delta = b1*delta + b3*delta^3; Cm_q = c1*q + c3*q^3; % 动压与力矩 qbar = 0.5 * rho * V^2; M_pitch = qbar * S * d * (Cm_alpha + Cm_delta + Cm_q); % 法向力与法向过载 Cn = n1*alpha + n3*alpha^3 + m1*delta; F_normal = qbar * S * Cn; nz = F_normal / (m * g); % 法向过载 [g] % 角加速度 q_dot = M_pitch / Iy;

这里有两个容易翻车的点。第一，攻角变化率的表达式在正负 20 度范围内做了化简，超出这个范围多项式逼近会失真，所以仿真里必须对攻角做限幅，否则大机动时力矩会算出离谱的值。第二，Z 轴正方向指向下，法向过载和位置的符号要统一，很多同学画出来的弹道上下颠倒，就是符号约定没对齐。我的习惯是在模型最外层放一个符号约定注释块，把每个物理量的正方向写清楚，改模型前先看一眼。

3.3 三回路自动驾驶仪的增益调度

自动驾驶仪控制的是法向过载，结构采用经典三回路：内环速率陀螺提供阻尼，中环加速度计反馈过载，外环积分消除稳态误差。控制器增益不是固定值，而是根据攻角和马赫数在二维查找表中调度，并在 10000 英尺高度上调参以获得稳健性能。实现上，增益表用 Simulink 的 Lookup Table 模块，两个输入分别是攻角和马赫数，输出是三个回路的增益组合。

抗饱和是这里的关键设计。当弹翼指令超过最大限值时，积分器如果继续累积，退出饱和后会出现明显的过冲。通常的做法是在积分器前加一个抗饱和增益，检测到舵面饱和就把积分输入切断或回退。这个逻辑在非线性 Simulink 模型里测试最有效，因为线性化模型根本体现不出饱和效应。我一般会专门做一组“大过载指令阶跃”实验，看舵面饱和后恢复的过程有没有拖尾振荡，有的话就调抗饱和增益。

4. 导引头与制导计算机：跟踪回路和状态机的落地

4.1 导引头跟踪回路的滤波与天线罩像差

导引头子系统驱动万向节让天线对准目标，同时为制导律提供视线角速率估计。跟踪器回路时间常数设为 0.05 秒，这个值是在响应速度和噪声传输之间折中的结果：再小噪声会明显放大，再大跟踪会滞后。稳定回路补偿弹体滚转速率，增益取稳定速率陀螺带宽允许范围内的最高值。视线角速率估计值是两路变化速率之和再滤波：一路是稳定速率陀螺测得的碟形角变化率，另一路是接收器测得的角跟踪误差变化率，估算器滤波器带宽取自动驾驶仪带宽的一半。

天线罩像差是雷达制导导弹必须建模的寄生反馈：保护罩形状使回波信号失真，给出错误的目标视角读数。常用逼近方法是假设万向节角度和失真幅度呈线性关系，用一个增益模块实现。这个增益看着不起眼，但它会直接耦合进制导回路，增益给大了整个闭环会自激。调试时先把它置零跑通基线，再逐步加大，观察视线角速率估计是否出现持续振荡。

4.2 制导计算机的 Stateflow 状态机设计

制导计算机用 Stateflow 实现，制导部分有 4 个模式、5 个子状态：目标搜索、目标锁定、雷达导引、盲区、任务中止；引信部分有 2 个子状态：无效、武装。状态转移的书写格式是“触发[条件]{条件动作}/{转换动作}”。指令逻辑按 100 Hz 更新，默认进入目标搜索，导引头线性转动搜索，万向节框架角超过正负 30 度时反向；搜索超过 7 秒进入任务中止并自毁；捕获成功进入锁定，0.2 秒后进入雷达导引，制导律开始给过载指令；丢失目标回到搜索；弹目距离小于 200 米进入盲区。

引信状态跟随制导状态变化：默认保险关闭；进入任务中止立即开启并自毁；雷达导引且距离小于 1000 米时开启，为起爆做准备；丢失目标回到搜索时保险关闭。这套时序逻辑用 Stateflow 画出来一目了然，但用纯 Simulink 模块搭会非常痛苦，这也是选 Stateflow 的原因。下面是一个状态转移的示意写法：

% Stateflow 状态转移条件（示意，实际在 Stateflow 图形界面中配置） % 状态: Search -> Lock -> Guidance -> BlindZone / Abort % Search -> Lock after(0.2, sec)[acquire == 1] / mode = LOCK; % Lock -> Guidance after(0.2, sec)[acquire == 1] / mode = GUIDANCE; enable_guidance = 1; % Guidance -> Search（丢失目标） [acquire == 0] / mode = SEARCH; enable_guidance = 0; fuze_arm = 0; % Guidance -> BlindZone（进入盲区） [range < 200] / mode = BLINDZONE; % Search -> Abort（搜索超时） after(7, sec) / mode = ABORT; fuze_arm = 1; detonate = 1; % Guidance 且距离小于 1000m 时引信武装 [range < 1000 && mode == GUIDANCE] / fuze_arm = 1;

状态机的坑在于事件触发和条件判断的先后顺序。如果“捕获成功”和“搜索超时”在同一时刻满足，Stateflow 按转移的优先级决定走哪条，优先级没设对会出现该自毁却进了锁定的情况。我的做法是把所有转移的优先级显式标出来，并在仿真里注入边界时序做测试，比如让捕获信号恰好在第 7 秒到达，看状态机走哪条路。

4.3 弹目相对几何与角度命名对齐

弹目相对位置关系里涉及几个角度：弹体姿态角、视线角、万向节框架角、视线角速率。Simulink 模型里用英文命名对应：Attitude、Look Angle、Gimbal Angle、Sightline Rate 和 Sigmadot。命名对齐看着是小事，但制导律公式里的每一项都要和模型信号一一对应，名字对不上，调试时就得反复翻文档确认哪个是哪个。我一般会在模型顶层建一个信号字典，把每个角度的物理意义、正方向、单位写在一张表里，改制导律时直接查表，比翻报告快得多。

5. 三种制导律的实现与对比：PNG、NSMC 与随机滑模

5.1 比例导引的基准实现与参数选择

比例导引是基准，形式简单：法向过载指令正比于接近速度乘以视线角速率。模型里比例系数取 -3.5 时，仿真结果显示导弹爆炸时距目标 0.2682 米，落在杀伤半径内。这个系数不是随便选的，导航系数取 3 附近是理论最优的常见结论，负号来自 Z 轴指向下的符号约定。实现时要注意接近速度的获取：雷达制导可以用多普勒跟踪设备测量，仿真里直接用弹目距离的导数。

% 比例导引（PNG）法向过载指令 % Vc: 接近速度[m/s], sigma_dot: 视线角速率[rad/s], N: 导航系数 N = 3.5; nz_cmd = N * Vc * sigma_dot; % 法向过载指令 [g]，符号按 Z 轴约定 nz_cmd = saturate(nz_cmd, -nz_max, nz_max); % 过载限幅

PNG 的优点是简单实用、对无机动目标拦截精度高，缺点是攻角不趋于零、指令舵偏角相对较大。做对比实验时，PNG 作为基线，后面两种制导律的改进点才有参照。

5.2 基于一般趋近律的滑模制导律

滑模制导选取视线角速率为被控量，滑模面取 s 等于视线角速率，趋近律用一般形式 s_dot = -k·sign(s)。构造 Lyapunov 函数可以证明稳定性。控制量 u 为导弹法向加速度，目标匀速直线运动时目标加速度为零，化简后指令加速度与视线角速率、视线角、接近速度相关。

实验中发现一个关键问题：弹目相对距离 r 变化很大，k 取常数时，距离远则指令加速度过大，距离近则指令失效。解决办法是把 k 设计成时变项，对 k 和 r 做耦合设计。改进后导弹爆炸时距目标仅 0.063 米，比 PNG 精度更高。和 PNG 相比，NSMC 的指令舵偏角更小、法向加速度跟踪精度更高，但攻角不趋于零，整体调节更平缓。

% 一般趋近律滑模制导（NSMC），k 与相对距离耦合 % r: 弹目距离[m], sigma: 视线角[rad], sigma_dot: 视线角速率[rad/s] % Vc: 接近速度[m/s], k0: 趋近律基准增益 k = k0 / max(r, r_min); % 时变增益，避免远距离指令过大 s = sigma_dot; % 滑模面 u = -k * sign(s) + Vc * sigma_dot; % 指令加速度（示意形式） nz_cmd = u / g; % 转成法向过载 nz_cmd = saturate(nz_cmd, -nz_max, nz_max);

这里的 r_min 是防止除零的下限，通常取几十米量级。sign 函数在 s 过零附近会高频抖振，仿真里可以用饱和函数或边界层替代，但要注意边界层厚度会影响稳态精度，太厚了精度掉回 PNG 水平。

5.3 随机滑模变结构制导律与 H∞ 方法的定位

随机滑模变结构制导律针对的是实际拦截中的不确定因素和随机因素，让制导控制量具备一定鲁棒性，其理论推导出的形式包含 PNG 的部分，导航系数为 3 的最优性也能从中推出。H∞ 制导律的出发点不同，是为应对干扰和噪声设计的高性能策略，但最终设计出的制导律同样包含 PNG 的成分。这其实说明了一件事：比例导引那套简单结构之所以几十年不倒，是因为它在各种鲁棒设计里都会作为特例浮现出来。

三种制导律放在一起对比时，建议固定同一组初始条件和目标运动，只换制导律模块，输出脱靶量、最大过载、舵偏角峰值、攻角包线四组曲线。这样对比才有说服力，答辩时也容易讲清楚每种方法的取舍。

6. 避坑与排查：这套模型最容易翻车的五个地方

6.1 代数环导致仿真卡死或结果异常

现象：仿真启动后进度条不动，或者报代数环错误，或者能跑但结果明显不对。原因：弹体动力学、气动计算、自动驾驶仪之间存在直接馈通，某个模块的输出又反馈回自己的输入，形成代数环。解决：在反馈路径上插入单位延迟或低通滤波打断代数环，延迟步长取仿真步长的一到两步；同时检查是否有模块误用了直接馈通端口。我一般会在搭建阶段就用 Simulink 的代数环诊断功能扫一遍，别等跑起来才发现。

6.2 攻角限幅缺失导致力矩发散

现象：大机动指令下弹道突然发散，力矩曲线出现数量级跳变。原因：气动系数的三次多项式逼近只在正负 20 度攻角内有效，超出后多项式外推给出错误力矩。解决：在攻角计算后加饱和限幅，限幅值按模型适用范围设定；同时在气动系数模块里加一个越界告警，仿真时一旦触发就停下来检查指令是否过大。

6.3 状态机时序竞争导致模式乱跳

现象：导弹在搜索和锁定之间反复切换，或者该进盲区时进了中止。原因：多个转移条件在同一时刻满足，优先级没设对；或者捕获信号和超时信号的时间戳太接近。解决：显式设置转移优先级，搜索超时的判断放在捕获判断之后；用边界时序测试注入“捕获信号恰好在超时时刻到达”的场景，确认状态机行为符合预期。

6.4 增益调度表插值越界

现象：仿真到某个高度或马赫数时增益突然跳变，过载响应出现台阶。原因：查找表的断点范围没覆盖整个飞行包线，越界后按端点值外推或报错。解决：把攻角和马赫数的断点范围留出余量，覆盖 2 到 4 马赫、3050 到 18290 米的全部工况；在表模块外再加一层输入限幅，确保不会查到表外。

6.5 符号约定不统一导致弹道镜像

现象：弹道曲线上下颠倒，或者脱靶量符号和预期相反。原因：Z 轴正方向指向下，但部分模块按向上为正搭建，混用后整体镜像。解决：在模型顶层统一符号约定并写成注释，所有涉及位置、过载、角度的模块按同一约定实现；画图时保留 Z 方向数据的负号，避免视觉上误判。

7. 验收与答辩：怎么证明这套仿真“跑对了”

验收这套模型，不能只看“仿真能跑完、弹道能画出来”，那只能说明没报错。真正要证明的是三件事：各子系统单独可信、闭环行为符合物理、制导律对比有统计意义。

第一步做子系统级验收。大气模型单独扫高度，四条曲线光滑单调且在 11 km 处连续；弹体模型给一组配平条件，看攻角、俯仰角速率是否收敛到合理值；自动驾驶仪做阶跃响应，看超调量、调节时间、饱和恢复是否达标。每个子系统都留一张验收记录表，答辩时直接展示，比口头说“我调过了”有说服力。

第二步做闭环时序验收。重点看状态机的五个模式切换时刻和引信武装时序：搜索到锁定的延迟是不是 0.2 秒、距离 1000 米时引信是否武装、200 米进盲区是否触发、7 秒超时是否自毁。这些时刻可以从仿真日志里直接读出来，和设计值逐条比对。

第三步做制导律对比验收。同一初始条件下跑 PNG、NSMC、随机滑模三组，统计脱靶量、最大法向过载、舵偏角峰值、攻角范围，做成对比表。PNG 脱靶量 0.2682 米、NSMC 0.063 米这组数据就是现成的参照，但要注意每组至少跑多个初始航向角，单条弹道的脱靶量偶然性太大，统计分布才站得住。

答辩时最容易被问的是“你的模型和真实导弹差多少”。诚实回答：纵向平面、目标不机动、气动系数是多项式逼近，这些简化决定了结论的适用范围，但也正是这些简化让制导律的设计验证成为可能。把简化假设列清楚，比硬说“很真实”更让人信服。

血泪经验是：我曾经为了赶进度跳过子系统验收直接跑闭环，结果弹道怎么调都不对，回头逐个模块查了两天才发现是大气模型 11 km 处密度跳变。从那以后我每次搭这类多子系统模型，都强制先把每个子系统单独跑一遍验收再串闭环，宁可前面多花半天，也不在后面翻车。希望帮到你。

本文还有配套的精品资源，点击获取