mle.asv

无线传感器节点定位算法

x=[0:.:1];y=[0:.1:1]';
[X,Y]=meshgrid(x,y);

x2=0;y2=0;%参考节点
x3=1;y3=0;
x4=0;y4=1;
x5=1;y5=1;
d12=dist(X,Y,x2,y2);d_12=dhat(d12);
d13=dist(X,Y,x3,y3);d_13=dhat(d13);
d14=dist(X,Y,x4,y4);d_14=dhat(d14);
d15=dist(X,Y,x5,y5);d_15=dhat(d15);

d23=dist(x2,y2,x3,y3);d_23=dhat(d23);
d24=dist(x2,y2,x4,y4);d_24=dhat(d24);
d25=dist(x2,y2,x5,y5);d_25=dhat(d25);

d34=dist(x3,y3,x4,y4);d_34=dhat(d34);
d35=dist(x3,y3,x5,y5);d_35=dhat(d35);

d45=dist(x4,y4,x5,y5);d_45=dhat(d45);

delta=(log(d_12^2./d12^2))^2+(log(d_13^2./d13^2))^2+(log(d_14^2./d14^2))^2+(log(d_15^2./d15^2))^2+...
    (log(d_23^2./d23^2))^2+(log(d_24^2./d24^2))^2+(log(d_25^2./d25^2))^2+(log(d_34^2./d34^2))^2+...
    (log(d_35^2./d35^2))^2+(log(d_45^2./d45^2))^2;
surfc(x,y,delta);