solve_node_coordinate.asv

目标定位和跟踪的源程序

%% solve the node coordination;
%% 2005-12-5;MaDengYong;

L=565;
ag=(73+33/60)*pi/180;
K=tan(ag);

x193=281.8;

A=K^2+1;
B=-2*K^2*x193;
C=K^2*x193^2-L^2;

delt=B^2-4*A*C;

x191=(-B-sqrt(delt))/(2*A)
y191=sqrt(L^2-x191^2)