【MATLAB代码】追踪法制导的程序，适用于三维平面，目标是运动的，带绘图和捕获时间

追踪法（追踪导引法）是一种常见的导弹导引方式，其基本原理是保持导弹的速度矢量始终指向目标。在追踪法中，导弹的加速度可以表示为指向目标的加速度。

运行结果

三维追踪图示：

二维图示：

结果输出：

MATLAB源代码

以下是完整的MATLAB代码，粘贴到空脚本中即可直接运行：

% 追踪法制导（前置角为0）MATLAB代码实现导弹以追踪法制导攻击移动目标，三维
% 2025-06-09/Ver1
%% 初始化
clc; clear; close all;
rng(0);
% 时间步长和总时间
dt = 0.1;  % 时间步长 (秒)
T_total = 1000;  % 模拟总时间 (秒)
N = T_total / dt;  % 总时间步数

% 目标初始位置和速度
target_pos = [500, 500, 500];  % 目标初始位置 (x, y, z)
target_vel = [10, -5, 2];      % 目标速度向量 (vx, vy, vz)

% 导弹初始位置和速度
missile_pos = [10, 10, 10];       % 导弹初始位置 (x, y, z)
missile_speed = 30;            % 导弹固定速度 (m/s)

% 数据存储
target_trajectory = zeros(N, 3);  % 存储目标轨迹
missile_trajectory = zeros(N, 3); % 存储导弹轨迹
distance_to_target = zeros(N, 1); % 存储导弹与目标的距离

%% 仿真循环
for i = 1:N
    % 记录当前位置
    target_trajectory(i, :) = target_pos;
    missile_trajectory(i, :) = missile_pos;

    % 计算导弹与目标的距离
    rel_pos = target_pos - missile_pos;     % 相对位置矢量
    distance_to_target(i) = norm(rel_pos);  % 导弹与目标的距离

    % 如果距离小于一定阈值，认为击中目标
    if distance_to_target(i) < 1
        disp(['目标在时间 ', num2str(i*dt), ' 秒被击中！']);
        break;
    end

    % 追踪法制导计算
    % 导弹速度矢量始终指向目标
    los_unit_vector = rel_pos / norm(rel_pos); % 视线方向单位矢量
    missile_vel = missile_speed * los_unit_vector; % 导弹速度矢量

    % 更新位置
    missile_pos = missile_pos + missile_vel * dt; % 更新导弹位置
    target_pos = target_pos + target_vel * dt;   % 更新目标位置
end