%~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~??DV-Hop算法??~~~~~~~~~~~~~~~~~~~~~~~~
%~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
%?BorderLength-----正方形區(qū)域的邊長(zhǎng)，單位：m
%?NodeAmount-------網(wǎng)絡(luò)節(jié)點(diǎn)的個(gè)數(shù)
%?BeaconAmount---信標(biāo)節(jié)點(diǎn)數(shù)
%?Sxy--------------用于存儲(chǔ)節(jié)點(diǎn)的序號(hào)，橫坐標(biāo)，縱坐標(biāo)的矩陣
%Beacon----------信標(biāo)節(jié)點(diǎn)坐標(biāo)矩陣;BeaconAmount*BeaconAmount
%UN-------------未知節(jié)點(diǎn)坐標(biāo)矩陣;2*UNAmount
%?Distance------未知節(jié)點(diǎn)到信標(biāo)節(jié)點(diǎn)距離矩陣;2*BeaconAmount
%h---------------節(jié)點(diǎn)間初始跳數(shù)矩陣
%X---------------節(jié)點(diǎn)估計(jì)坐標(biāo)初始矩陣X=[xy]‘
%?R------------------節(jié)點(diǎn)的通信距離，一般為10-100m

clearclose?all;
BorderLength=100;
NodeAmount=100;
BeaconAmount=20;
UNAmount=NodeAmount-BeaconAmount;
R=30;
%?D=zeros（NodeAmountNodeAmount）;%未知節(jié)電到信標(biāo)節(jié)點(diǎn)距離初始矩陣；BeaconAmount行NodeAmount列
h=zeros（NodeAmountNodeAmount）;%初始跳數(shù)為0；BeaconAmount行NodeAmount列
X=zeros（2UNAmount）;%節(jié)點(diǎn)估計(jì)坐標(biāo)初始矩陣

%~~~~~~~~~~~~~~~~~~~~~~~~~~~~~在正方形區(qū)域內(nèi)產(chǎn)生均勻分布的隨機(jī)拓?fù)鋨~~~~~~~~~~~~~~~~~~~
C=BorderLength.*rand（2NodeAmount）;
%帶邏輯號(hào)的節(jié)點(diǎn)坐標(biāo)
Sxy=[[1:NodeAmount];C];
Beacon=[Sxy（21:BeaconAmount）;Sxy（31:BeaconAmount）];%信標(biāo)節(jié)點(diǎn)坐標(biāo)
UN=[Sxy（2（BeaconAmount+1）:NodeAmount）;Sxy（3（BeaconAmount+1）:NodeAmount）];%未知節(jié)點(diǎn)坐標(biāo)
%畫(huà)出節(jié)點(diǎn)分布圖
plot（Sxy（21:BeaconAmount）Sxy（31:BeaconAmount）‘r*‘Sxy（2（BeaconAmount+1）:NodeAmount）Sxy（3（BeaconAmount+1）:NodeAmount）‘k.‘）
xlim（[0BorderLength]）;
ylim（[0BorderLength]）;
title（‘*?紅色信標(biāo)節(jié)點(diǎn)?.?黑色未知節(jié)點(diǎn)‘）
%~~~~~~~~~~~~~~~~~~~~~~~~~~~~初始化節(jié)點(diǎn)間距離、跳數(shù)矩陣~~~~~~~~~~~~~~~~~~~~~~
for?i=1:NodeAmount
????for?j=1:NodeAmount
????????Dall（ij）=（（Sxy（2i）-Sxy（2j））^2+（Sxy（3i）-Sxy（3j））^2）^0.5;%所有節(jié)點(diǎn)間相互距離
????????if?（Dall（ij）<=R）&（Dall（ij）>0）
????????????h（ij）=1;%初始跳數(shù)矩陣
????????elseif?i==j
????????????h（ij）=0;
????????else?h（ij）=inf;
????????end
????end
end
%~~~~~~~~~~~~~~~~~~