最小二乘定位算法 Matlab

clear;
clc;
close all;

disp（‘---------------------------------------------------------------------‘）;
disp（‘刘钰洁最小二乘法对未知节点进行定位（未知节点静止）‘）;
disp（‘Author: XU Yuan‘）;
disp（‘Affiliation: Southeast University‘）;
disp（‘Date: 2014-04-12‘）;
disp（‘---------------------------------------------------------------------‘）;

% 设置RN节点坐标
% x坐标
x = [0 0 10 10 7];
% y坐标
y = [0 10 0 10 8];
n=4; % BN节点数目
RN_n = 5; % RN节点数目

% RN节点坐标显示
figure;
plot（x（1:）y（1:）‘k^‘）;
hold on

axis（[0 10 0 10]）;%这个是给的x轴和y轴的范围

% 设置盲节点坐标（1个）
max=10;
mx=max*rand（1n）;
my=max*rand（1n）;%随机生成4个坐标
comm_dist = 20; % 通信距离设置

% 从4个mx my中选择出一个坐标保存到nx nx中作为待定位盲节点
for j=1:ni=1:n;
    for jj = 1:RN_n
        % 首先计算BN节点到所有RN节点的真实距离
        d（jj）=sqrt（（mx（1j）-x（1jj））^2+（my（1j）-y（1jj））^2）;
    end
        % 与comm_dist进行比较，看是不是在<=的范围里面
     if d（jj）<=