noise_distance_matrix.m

WSN中DOA算法的mds定位

function D=noise_distance_matrix(X,r)
if r==1
D=zeros(size(X,1),size(X,1));
for i=1:size(X,1)
    for j=i+1:size(X,1)
             D(i,j)=norm([X(i,1)-X(j,1);X(i,2)-X(j,2)])+normrnd(0,sqrt(2.5e-3)/1);
    end
end
D=D+D';
%E=zeros(size(X,1),size(X,1));
%for k=1:50
  %  E=E+normrnd(0,(2.5e-3),size(X,1),size(X,1));
%end
%E=(E+E')/2;
%E=0.02.*E;
%D=D+E;
%for i=1:size(X,1)
   % D(i,i)=0;
%end
end
if r==2
    D=zeros(size(X,1),size(X,1));
for i=1:size(X,1)
    for j=i+1:size(X,1)
            D(i,j)=norm([X(i,1)-X(j,1);X(i,2)-X(j,2)]);
    end
end
D=D+D';
end