create_network.m

LSE参考点定位算法在UWB中的仿真

% 
% FUNCTION : "create_network"
%
%  在一个正方形区域里产生若干个结点并计算任两点间的距离
%  输入参数：
%  N：结点个数
%  正方形边长：area_side
%  是否输出图形：G
% 
%  输出：
%  一个包含各个结点坐标参数的大小为Nx2的二维数组
%  一个包含任两点间距离大小为NxN的二维数组
%

function [positions, ranges] = create_network(N,area_side,G)
for i = 1:N
    positions(i,1)=rand*area_side;
    positions(i,2)=rand*area_side;
    j=1;
    for j=1:(i-1)
        ranges(i,j)= sqrt((positions(i,1) -...
           positions(j,1))^2 + (positions(i,2) -...
           positions(j,2))^2);
        while(ranges(i,j)==0)
                X(i)=rand*50;
                Y(i)=rand*50;
                ranges(i,j)=sqrt((positions(i,1)-...
                   positions(j,1))^2+(positions(i,2)-...
                   positions(j,2))^2);
        end
        ranges(j,i)=ranges(i,j);
    end
end
if G
    scatter(positions(:,1),positions(:,2),'filled');
    axis([0 area_side 0 area_side]);
    xlabel('X [m]');
    ylabel('Y [m]');
    box on;
end