参考文献:周荻那本变结构导引律的设计
clear
%===================================================================================
%--------------------------------情景说明------------------------------------------
%目标正弦机动,At=Asin(*),速度大小不变
%导弹速度大小为常量
%==========================================================================
Vt=500;
Xt=10000;
Yt=8000;
ThetaT=pi/9;
Xt1=[]; %存放中间数据,用来分析结果,如作图
Yt1=[];
At1=[];
Vm=2000;
Xm=0;
Ym=0;
ThetaM=2*pi/9;
Xm1=[]; %存放中间数据,用来分析结果,如作图
Ym1=[];
Am1=[];
AngleV=[];
DotQ1=[];
Q1=[];
n=1;
Xt1(n)=Xt;
Yt1(n)=Yt;
Xm1(n)=Xm;
Ym1(n)=Ym;
Q=atan((Yt-Ym)/(Xt-Xm));
DotQ=((Vt*sin(ThetaT)-Vm*sin(ThetaM))*(Xt-Xm)-(Yt-Ym)*(Vt*cos(ThetaT)-Vm*cos(ThetaM)))/((Xt-Xm)^2+(Yt-Ym)^2);
DotR=((Xm-Xt)*(Vm*cos(ThetaM)-Vt*cos(ThetaT))+(Ym-Yt)*(Vm*sin(ThetaM)-Vt*sin(ThetaT)))/sqrt((Xm-Xt)^2+(Ym-Yt)^2);
t=0;
Dt=0.01;
k=10;
E1=40;
E2=0.01;
c=2;
Qd=-pi/2;
At=20;
while(DotR<=0)
DotQ1(n)=DotQ;
Q1(n)=Q;
%if(abs(t-3)<=1e