无线定位算法仿真，用matlab做的，本人觉得对做定位很有用

clear clc %建立坐标系 for i=1:1:10 for j=1:1:10 x(j+(i-1)*10)=(i-1)*10; y(j+(i-1)*10)=(j-1)*10; end end figure plot(x,y,'.') hold on %在坐标系内随机分布50个待定位节点，以红色星号表示 axis([0 100 0 100]) xy=[x;y] hold on xm=90; ym=90; n=50; for i=1:1:n Sx(i)=rand(1,1)*xm; Sy(i)=rand(1,1)*ym; plot(Sx(i),Sy(i),'r*') xlabel('x轴') ylabel('y轴') hold on end dm=30; m=100; for j=1:1:n SS=[Sx(j);Sy(j)]; k=0; %以dm为半径，寻找每个待定位节点周围的锚节点 for i=1:1:m d=norm((xy(:,i)-SS),2); %%%%%%%%%%%设定权值%%%%%%%%%%%% if d<=dm %xy是一个2行m列的矩阵，所有横坐标为第一行，纵坐标为第二行；xx（j，i） %表示第j个待定位节点的第i个锚节点的横坐标 p(j,i)=1/d ; xx(j,i)=xy(1,i); yy(j,i)=xy(2,i); k=k+1; else p(j,i)=0; xx(j,i)=0; yy(j,i)=0; end end %计算范围内所有锚节点的平均坐标，即质心，以空心圆表示 if k~=0 cent(:,j)=[sum(xx(j,:));sum(yy(j,:))]/k; else cent(:,j)=0; end plot(cent(1,j),cent(2,j),'o') hold on %距离加权的改进质心，以三角表示 if k~=0 centx(:,j)=[sum(xx(j,:).*p(j,:));sum(yy(j,:).*p(j,:))]/(sum(p(j,:))); else centx(:,j)=0; end plot(centx(1,j),centx(2,j),'^') hold on %画出每个待定位节点与所属于的质心的距离，以绿线表示 plot([cent(1,j) Sx(j)],[cent(2,j) Sy(j)],'g') Title('Centroid') hold on %画出每个待定位节点与所属于的加权质心的距离，以红线表示 plot([centx(1,j) Sx(j)],[centx(2,j) Sy(j)],'m') Title('xCentroid') hold on %求出每个待定位节点的定位误差 MM=[cent(1,j);cent(2,j)] e(j)=norm((MM-SS),2)/dm NN=[centx(1,j);centx(2,j)] err(j)=norm((NN-SS),2)/dm end figure axis([0 n 0 10]) j=1:1:n %绿线表示质心与实际位置的误差 plot(j,e(j) ,'-g.') hold on %红线表示加权质心与实际位置的误差 plot(j,err(j) ,'-m.') hold on Title('Centroid') E=sum(e)/n ERR=sum(err)/n