neighbordst.m

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

function s=neighbordst(nodeA,nodeB,error)
x1=nodeA.tPosition.x;
y1=nodeA.tPosition.y;
z1=nodeA.ePosition.z;
x2=nodeB.ePosition.x;
y2=nodeB.ePosition.y;
z2=nodeB.ePosition.z;
d1=(x1-x2)^2+(y1-y2)^2+(z1-z2)^2;
s=sqrt(d1)*error;