参考文献:《几种增大空地导弹落角的制导方式比较》
《Strategic and tactical missile guidance》
clear
clc
%-----------导弹参数---------
V_m=260;%飞行速度
X_m=0;
Y_m=1000; %初始飞行高度
theta_m=0*pi/180; %弹道倾角
%----------目标参数---------
V_t=0; %静止目标
X_t=4800;
Y_t=0;
theta_t=0;
dtheta_t=0;
n_t=0;
A_t=0;
R=sqrt((X_m-X_t)^2+(Y_m-Y_t)^2);
q=atan((Y_t-Y_m)/(X_t-X_m));
dR=((X_m-X_t)*(V_m*cos(theta_m)-V_t*cos(theta_t))+(Y_m-Y_t)*(V_m*sin(theta_m)-V_t*sin(theta_t)))/sqrt((X_m-X_t)^2+(Y_m-Y_t)^2);
dq=((X_t-X_m)*(V_t*sin(theta_t)-V_m*sin(theta_m))-(Y_t-Y_m)*(V_t*cos(theta_t)-V_m*cos(theta_m)))/((X_m-X_t)^2+(Y_m-Y_t)^2);
n_m=-q+theta_m;
c=3;
qf=-90*pi/180;
g=9.8;
n=1;
t=0;
dt=0.01;
while (dR<0)
t_go=R/abs(dR);
Am=4*dq*abs(dR)+2*abs(dR)*(q-qf)/t_go+g*cos(theta_m); %考虑重力补偿因素的弹道成型制导律
dtheta_m=Am/V_m; %纵向通道:弹道倾角变化函数