solve_node_coordinate.m

目标定位和跟踪的源程序

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

L=560;
ag=(42+9/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)