distance.m

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

% distance.m for use with C13L2 need to resave this as distance.m

function y=distance(xt,yt,xf,yf)
r=sqrt(xt^2+yt^2);
a=2.0926e7;
cbeta=(xt*xf+yt*yf)/(r*a);
if cbeta<1.
	beta=acos(cbeta);
	y=a*beta/6076.;
else
	y=(xt-xf)/6076.;
end