資源簡介
基于最小二乘算法的室內(nèi)定位算法,已測試可用
代碼片段和文件信息
clear;
clc;
close?all;
disp(‘---------------------------------------------------------------------‘);
disp(‘劉鈺潔最小二乘法對未知節(jié)點進行定位(未知節(jié)點靜止)‘);
disp(‘Author:?XU?Yuan‘);
disp(‘Affiliation:?Southeast?University‘);
disp(‘Date:?2014-04-12‘);
disp(‘---------------------------------------------------------------------‘);
%?設(shè)置RN節(jié)點坐標(biāo)
%?x坐標(biāo)
x?=?[0?0?10?10?7];
%?y坐標(biāo)
y?=?[0?10?0?10?8];
n=4;?%?BN節(jié)點數(shù)目
RN_n?=?5;?%?RN節(jié)點數(shù)目
%?RN節(jié)點坐標(biāo)顯示
figure;
plot(x(1:)y(1:)‘k^‘);
hold?on
axis([0?10?0?10]);%這個是給的x軸和y軸的范圍
%?設(shè)置盲節(jié)點坐標(biāo)(1個)
max=10;
mx=max*rand(1n);
my=max*rand(1n);%隨機生成4個坐標(biāo)
comm_dist?=?20;?%?通信距離設(shè)置
%?從4個mx?my中選擇出一個坐標(biāo)保存到nx?nx中作為待定位盲節(jié)點
for?j=1:ni=1:n;
????for?jj?=?1:RN_n
????????%?首先計算BN節(jié)點到所有RN節(jié)點的真實距離
????????d(jj)=sqrt((mx(1j)-x(1jj))^2+(my(1j)-y(1jj))^2);
????end
????????%?與comm_dist進行比較,看是不是在<=的范圍里面
?????if?d(jj)<=
- 上一篇:一致性算法
- 下一篇:matlab-KNN分類器
評論
共有 條評論