c4l6.m

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

count=0;
XNT = 96.6;
XNP = 3;
TAU = 1;
TF = 10;
T=0;
S=0;
TP=T+.00001;
X1=0;
X2=0;
X3=1;
X4=0;
X5=0.;
H=.01;
while TP <= (TF - 1e-5)
	STEP=1;
	FLAG=0;
	S=S+H;
	X1OLD=X1;
	X2OLD=X2;
	X3OLD=X3;
	X4OLD=X4;
	X5OLD=X5;
	while STEP <=1
		if FLAG==1
			STEP=2;
			X1=X1+H*X1D;
			X2=X2+H*X2D;
			X3=X3+H*X3D;
			X4=X4+H*X4D;
			X5=X5+H*X5D;
			TP=TP+H;
		end;
		X1D=X2;
		X2D=X3;
		Y1=(X4-X2)/TAU;
		TGO=TP+.00001;
		X3D=XNP*Y1/TGO;
		X4D=-Y1;
		X5D=X1*X1;
		FLAG=1;
	end;
	FLAG=0;
	X1=(X1OLD+X1)/2+.5*H*X1D;
	X2=(X2OLD+X2)/2+.5*H*X2D;
	X3=(X3OLD+X3)/2+.5*H*X3D;
	X4=(X4OLD+X4)/2+.5*H*X4D;
   X5=(X5OLD+X5)/2+.5*H*X5D;
   S=S+H;
   if S>=.000999
      S=0.;
      XMUDNT=XNT*sqrt(X5/TGO);
      count=count+1;
      ArrayTP(count)=TP;
      ArrayXMUDNT(count)=XMUDNT;
   end;
end
figure
plot(ArrayTP, ArrayXMUDNT),grid
title('Adjoint model using shaping filter approach')
xlabel('Flight Time (S)')
ylabel('Miss Dist Standard Deviation (Ft)')
axis([00,10,00,30])
clc
output=[ArrayTP',ArrayXMUDNT'];
save datfil.txt output /ascii
disp('Simulation Complete')