三维比例导引 matlab,三维比例导引律（源程序）

%具有角度和时间约束的导弹最优全弹道设计

%算法三：比例导引末制导

%说明：在仿真中，下标"_m"表示拦截弹参数，下标"_t"表示目标弹参数

clear

clc

%---------------------拦截弹参数设置-----------------------

V_m=260; % 单位：m/s，导弹飞行速度

theta_m=45*pi/180;%单位：rad，初始弹道倾角

fea_m=10*pi/180;%单位：rad，初始弹道偏角

H=1000;%单位：m，飞行高度

g=9.6;%单位：m/s^2，重力加速度

X_m=0; %单位：m，拦截弹位置坐标，X轴

Y_m=1000; %单位：m，拦截弹位置坐标，Y轴

Z_m=0; %单位：m，拦截弹位置坐标，Z轴

%---------------------目标弹参数设置-----------------------

V_t=150; %单位：m/s，目标弹飞行速度

theta_t=60*pi/180;%单位：rad，初始弹道偏角

fea_t=0*pi/180;%单位：rad，初始弹道偏角

X_t=1000; %单位：m，目标弹位置坐标，X轴