|
%信標(biāo)節(jié)點(diǎn)位于等邊三角形頂點(diǎn)的仿真 clc clear all %A,B,C為三個(gè)選定的信標(biāo)節(jié)點(diǎn),節(jié)點(diǎn)坐標(biāo)已知(為便于防真及驗(yàn)證,代碼中采用的等邊三角形) for t = 1:5 A = [0,0]; B = [5*t,5*t*sqrt(3)]; C = [10*t,0]; nums = [A(1),A(2),B(1),B(2),C(1),C(2)]; p = min(nums); q = max(nums); L = sqrt((A(1)-C(1))^2+(A(2)-C(2))^2); m = 5; %生成在[p,q]上滿足均勻分布的隨機(jī)數(shù)矩陣 %即生成一組m行2列的有可能落在等邊三角形區(qū)域內(nèi)的坐標(biāo) numbox = p+(q-p)*rand(m,2);
%計(jì)數(shù)初值,最終根據(jù)計(jì)算將隨機(jī)生成的點(diǎn)中落在等邊三角形區(qū)域內(nèi)的坐標(biāo)存放于新的矩陣 n = 1; for i = 1:m dA(i) = sqrt((numbox(i,1)-A(1))^2+(numbox(i,2)-A(2))^2); dB(i) = sqrt((numbox(i,1)-B(1))^2+(numbox(i,2)-B(2))^2); dC(i) = sqrt((numbox(i,1)-C(1))^2+(numbox(i,2)-C(2))^2); %將確實(shí)在等邊三角形區(qū)域內(nèi)的坐標(biāo)存入P_position矩陣 if (dA(i)<=L) & (dB(i)<=L) & (dC(i)<=L) P_position(n,1) = numbox(i,1); P_position(n,2) = numbox(i,2); n = n+1; end end %N為隨機(jī)生成的點(diǎn)中落在等邊三角形區(qū)域內(nèi)的點(diǎn)(測試點(diǎn))的個(gè)數(shù) N = n-1 if N == 0 disp('所取的隨機(jī)坐標(biāo)無一落在等邊三角形內(nèi),請(qǐng)?jiān)龃?/font>m值重新運(yùn)行程序.') return end
%計(jì)算測試點(diǎn)離三個(gè)頂點(diǎn)的實(shí)際距離 %dis為N行3列的矩陣,用于存放N個(gè)測試點(diǎn)分別到等邊三角形三個(gè)頂點(diǎn)A,B,C的實(shí)際距離 for i = 1:N dis(i,1) = sqrt((P_position(i,1)-A(1))^2+(P_position(i,2)-A(2))^2); dis(i,2) = sqrt((P_position(i,1)-B(1))^2+(P_position(i,2)-B(2))^2); dis(i,3) = sqrt((P_position(i,1)-C(1))^2+(P_position(i,2)-C(2))^2); end
%根據(jù)函數(shù)Distance計(jì)算測試點(diǎn)離三個(gè)頂點(diǎn)的測試距離(考慮了衰減及環(huán)境誤差等) %dis_test為N行3列的矩陣,用于存放N個(gè)測試點(diǎn)分別到等邊三角形三個(gè)頂點(diǎn)A,B,C的測試距離 a = 7; %由RSSI計(jì)算T-R距離時(shí)使用的參數(shù) for i = 1:N dis_test(i,1) = Distance(dis(i,1),a); dis_test(i,2) = Distance(dis(i,2),a); dis_test(i,3) = Distance(dis(i,3),a); end
%根據(jù)函數(shù)Triangle及求得的測試距離進(jìn)行定位 %P_calculate為N行2列的矩陣,用于存放定位后的N個(gè)坐標(biāo) for i = 1:N P_temp = Triangle(A,B,C,dis_test(i,1),dis_test(i,2),dis_test(i,3)); P_calculate(i,1) = P_temp(1); P_calculate(i,2) = P_temp(2); end
%由于測試距離相比真實(shí)距離有誤差,三角計(jì)算中的兩圓有可能無交點(diǎn),導(dǎo)致方程無實(shí)根. %于是P_calculate中會(huì)出現(xiàn)虛數(shù).在測試中虛數(shù)無實(shí)際意義,因此取其實(shí)部存放于另一矩陣 for i = 1:N P_calculate_real(i,1) = real(P_calculate(i,1)); P_calculate_real(i,2) = real(P_calculate(i,2)); end
%對(duì)比測試點(diǎn)的定位坐標(biāo)與實(shí)際坐標(biāo)之間的誤差 P_position; P_calculate; P_calculate_real; %計(jì)算定位結(jié)果與真實(shí)坐標(biāo)之間的距離誤差平均值e_average(測試點(diǎn)等概率) e_sum = 0; for i = 1:N e = sqrt((P_calculate_real(i,1)-P_position(i,1))^2+(P_calculate_real(i,2)-P_position(i,2))^2); e_sum = e_sum+e; end e_average = e_sum/N; e_average_percent = e_average/L;
e_average_box(t) = e_average e_average_percent_box(t) = e_average_percent end
x = [1:5:25]; e_average_box(t) = e_average; y = e_average_box(t); plot(x,y,'b-')
| 
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
