c19l2.m

这是本战略战术导弹制导的书中的matlab程序,比书中的 forchan程序简单易懂

VC=4000.;
XNT=32.2;
XNCLIMG=7.;
YIC=0.;
VM=3000.;
HEDEG=0.;
TAU=.3;
XNP=3.;
TA=5.;
R=-.01;
TF=10.;
Y=YIC;
YD=-VM*HEDEG/57.3;
YDIC=YD;
XNL=0.;
ELAMDH=0.;
X4=0.;
X5=0.;
TH=0.;
THH=0.;
T=0.;
H=.01;
S=0.;
XNCLIM=XNCLIMG*32.2;
n=0.;
while T<=(TF-1e-5)
   YOLD=Y;
	YDOLD=YD;
	XNLOLD=XNL;
	ELAMDHOLD=ELAMDH;
	X4OLD=X4;
	X5OLD=X5;
	THOLD=TH;
	THHOLD=THH;
   STEP=1;
   FLAG=0;
   while STEP<=1
      if FLAG==1
         STEP=2;
         Y=Y+H*YD; 	
         YD=YD+H*YDD;
         XNL=XNL+H*XNLD;
         ELAMDH=ELAMDH+H*ELAMDHD;
         X4=X4+H*X4D;
         X5=X5+H*X5D;
         TH=TH+H*THD;
         THH=THH+H*THHD;
         T=T+H;
      end
      TGO=TF-T+.00001;
      XLAM=Y/(VC*TGO);
      EPS=XLAM-TH-THH+R*THH;
      DD=5.*EPS/TAU;
      ELAMDHD=5.*(DD-ELAMDH)/TAU;
      XNC=XNP*VC*ELAMDH;
      if XNC>XNCLIM
         XNC=XNCLIM;
      end
      if XNC<-XNCLIM
         XNC=-XNCLIM;
      end
      X4D=5.*(XNC-X4)/TAU;
      X5D=5.*(X4-X5)/TAU;
      XNLD=5.*(X5-XNL)/TAU;
      THD=XNL/VM+TA*XNLD/VM;
      THHD=DD-THD;
      YDD=XNT-XNL;
      FLAG=1;
   end
   FLAG=0;
   Y=.5*(YOLD+Y+H*YD);
 	YD=.5*(YDOLD+YD+H*YDD);
	XNL=.5*(XNLOLD+XNL+H*XNLD);
	ELAMDH=.5*(ELAMDHOLD+ELAMDH+H*ELAMDHD);
	X4=.5*(X4OLD+X4+H*X4D);
	X5=.5*(X5OLD+X5+H*X5D);
	TH=.5*(THOLD+TH+H*THD);
	THH=.5*(THHOLD+THH+H*THHD);
   S=S+H;
   if S>=.0999
      S=0.;
      n=n+1;
      ArrayT(n)=T;
      ArrayY(n)=Y;
      ArrayXNCG(n)=XNC/32.2;
   end
end
figure
plot(ArrayT,ArrayXNCG),grid
xlabel('Time (Sec)')
ylabel('Missile Acceleration (G)')
clc
output=[ArrayT',ArrayY',ArrayXNCG'];
save datfil.txt output  -ascii
disp 'simulation finished'