加权质心定位算法

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（xy‘.‘）
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（11）*xm;
Sy（i）=rand（11）*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（ji）=1/d ;
xx（ji）=xy（1i）;
yy（ji）=xy（2i）;
k=k+1;
else
p（ji）=0;  
xx（ji）=0;
yy（ji）=0;
end
end
%计算范围内所有锚节点的平均坐标，即质心，以空心圆表示
if k~=0
cent（:j）=[sum（xx（j:））;sum（yy（j