testtps.m

Euclidean节点定位是由美国路特葛斯大学利用距离矢量路由和GPS定位原理提供出一种分布式自主定位算法

function testTPS()
a={50 100 0};
b={50 0 0};
x={50 50 50};
h=sqrt(100^2+100^2)
v=1500;
tmax=h/v
dab=100;
n=128;
dax=sqrt(50^2+50^2);
dxb=sqrt(50^2+50^2);
t1=dax/v;
t2=dxb/v+tmax;
s=0;
for i=1:n
err=1+normrnd(0,0.05^.5,1,1);
s=s+err;
end
err=s/n;
%while err<0
  % err=normrnd(0,0.05^.5,1,1);
%end
k=v*((t2-t1)*err)-h;
c=100^2-k^2;
a1=-4*c;
a2=-4*k*c;
h=50;
a3=c^2+4*(100^2)*(h^2);
if a2^2-4*a1*a3>=0
 dis1=(-a2+sqrt(a2^2-4*a1*a3))/(2*a1)
dis2=(-a2-sqrt(a2^2-4*a1*a3))/(2*a1)
dax
k
end