三维纯比例制导源代码

%具有碰撞角约束的三维纯比例导引律研究
%无人机空中加油自主会合控制器设计
%说明：在仿真中，下标"_m"表示追踪器参数，下标"_t"表示目标参数

clear
clc

%---------------------追踪器参数设置-----------------------
V_m=300; % 单位：m/s，飞行速度
theta_m=45*pi/180;%单位：rad，初始弹道倾角
fea_m=45*pi/180;%单位：rad，初始弹道偏角
X_m=0; %单位：m，位置坐标，X轴
Y_m=0; %单位：m，位置坐标，Y轴
Z_m=0; %单位：m，位置坐标，Z轴

%---------------------目标参数设置-----------------------
V_t=50; %单位：m/s，目标飞行速度
theta_t=0*pi/180;%单位：rad，初始弹道偏角
fea_t=0*pi/180;%单位：rad，初始弹道偏角
X_t=1000; %单位：m，目标位置坐标，X轴
Y_t=1000; %单位：m，目标位置坐标，Y轴
Z_t=0; %单位：m，目标位置坐标，Z轴

%------------------比例导引律参数设置-----------------------
N1=20; %纵向通道导引系数
N2=20;%偏航通道导引系数
g=9.8;

t=0; %单位：s，仿真时刻
dt=0.001;%单位：s&#x