wsn定位蒙特卡洛方法mcl的matlab實(shí)現(xiàn)源碼
《wsn定位蒙特卡洛方法mcl的matlab實(shí)現(xiàn)源碼》由會(huì)員分享,可在線閱讀,更多相關(guān)《wsn定位蒙特卡洛方法mcl的matlab實(shí)現(xiàn)源碼(11頁(yè)珍藏版)》請(qǐng)?jiān)谘b配圖網(wǎng)上搜索。
1、 clear; clc; %初始化工作 Ns = 20; Nn = 200; Vmax = 20; Xrange = 200; Yrange = 200; tr = 50; step = 20; N = 20; Nf = 3; %采樣盒子確定時(shí),估計(jì)位置要擴(kuò)大圓面積 ns_range = 200; %每個(gè)采樣盒子的最大采樣次數(shù) for i = 1:Ns Xseed(1,i)=rand(1,1)*Xrange; Yseed(1,i)=rand(1,1)*Yrange; end for i = 1:Nn Xnode(1,
2、i)=rand(1,1)*Xrange; Ynode(1,i)=rand(1,1)*Yrange; Xnode_g(1,i)=Xnode(1,i); %MCL估計(jì)位置,初始值設(shè)置為真實(shí)位置 Ynode_g(1,i)=Ynode(1,i); end %初始時(shí)刻的粒子群,for every node for i = 1:Nn for j = 1:N lx(i,j,1) = Xnode_g(1,i); ly(i,j,1) = Ynode_g(1,i); end end %figure(1
3、); %plot(Xseed,Yseed,'bo',Xnode,Ynode,'k*'); %節(jié)點(diǎn)們開(kāi)始運(yùn)動(dòng),每次定位完成才開(kāi)始下一次運(yùn)動(dòng),這里假設(shè)這個(gè)定位過(guò)程耗時(shí)非常短 %仿真步數(shù) for k=2:step %新的時(shí)刻,節(jié)點(diǎn)們先運(yùn)動(dòng)一下,RWP模型 for i = 1:Ns r = rand(1,1)*Vmax; thita = rand(1,1)*2*pi; Xseed(k,i) = Xseed(k-1,i) + r*cos(thita); if Ynode(k,i
4、) > Yrange || Ynode(k,i) < 0 Xnode(k,i) = Xnode(k-1,i) + r*cos(thita); Ynode(k,i) = Ynode(k-1,i) - r*sin(thita); end end %對(duì)每一個(gè)node逐個(gè)進(jìn)行定位 for i = 1:Nn %測(cè)試每個(gè)seed是否可以用來(lái)定位 A1 = []; %存儲(chǔ)1跳錨節(jié)點(diǎn)序號(hào) A2 = []; %存儲(chǔ)2跳錨節(jié)點(diǎn)序號(hào)
5、 for j = 1:Ns d1 = sqrt((Xnode(k,i)-Xseed(k,j))^2+(Ynode(k,i)-Yseed(k,j))^2); if d1<=tr A1 = [A1 j]; end if d1>tr && d1<=2*tr for m = 1:Nn if m ~= i
6、 dmi = sqrt((Xnode(k,i)-Xnode(k,m))^2+(Ynode(k,i)-Ynode(k,m))^2); dms = sqrt((Xnode(k,m)-Xseed(k,j))^2+(Ynode(k,m)-Yseed(k,j))^2); if dmi<=tr && dms<=tr A2 = [A2 j]; end
7、 end end end end %接下來(lái)要獲取采樣盒子,每個(gè)粒子都要有一個(gè)采樣盒子,然后還要進(jìn)行采樣,每個(gè)采樣盒子的采樣都要有一個(gè)次數(shù)限制,這里還是要分四種情況 temp1 = size(A1,2); temp2 = size(A2,2); %第一種情況 if temp1==0 && temp2==0
8、 Xnode_g(k,i)=Xnode_g(k-1,i); Ynode_g(k,i)=Ynode_g(k-1,i); for j = 1:N lx(i,j,k) = 0; %周?chē)鷽](méi)有錨節(jié)點(diǎn),沒(méi)法進(jìn)行定位,則粒子群全部置零 ly(i,j,k) = 0; end end %第二種情況 if temp1~=0 && tem
9、p2==0 for j = 1:N sambox1 = [ Xnode_g(k-1,i)-Nf*Vmax]; sambox2 = [ Xnode_g(k-1,i)+Nf*Vmax]; sambox3 = [ Ynode_g(k-1,i)-Nf*Vmax]; sambox4 = [ Ynode_g(k-1,i)+Nf*Vmax]; Xsambox_min(i,j,k) = max(sambox1);
10、 Xsambox_max(i,j,k) = min(sambox2); Ysambox_min(i,j,k) = max(sambox3); Ysambox_max(i,j,k) = min(sambox4); %從采樣盒子里采樣 lx(i,j,k) = unifrnd(Xsambox_min(i,j,k),Xsambox_max(i,j,k),1,1); ly(i,j,k) = unifr
11、nd(Ysambox_min(i,j,k),Ysambox_max(i,j,k),1,1); ns = 1; %濾波 and = []; for m = 1:temp1 d1(m) = sqrt((lx(i,j,k)-Xseed(k,A1(m)))^2+(ly(i,j,k)-Yseed(k,A1(m)))^2); end
12、 end ns = ns+1; end %進(jìn)行最終的判斷 and = []; for m = 1:temp1 d1(m) = sqrt((lx(i,j,k)-Xseed(k,A1(m)))^2+(ly(i,j,k)-Yseed(k,A1(m)))^2); if d1(m)<=tr a
13、nd = [and 0]; end if d1(m)>tr and = [and 1]; end end if sum(and)~=0 lx(i,j,k) = 0; ly(i,j,k) = 0; end
14、 end %至此 節(jié)點(diǎn) i 的粒子群已經(jīng)得到 %下面是進(jìn)行定位,粒子群的優(yōu)化 num_zero = 0; for j = 1:N if lx(i,j,k) == 0 num_zero = num_zero+1; end end %k時(shí)刻的定位位置 if
15、num_zero == N Xnode_g(k,i) = Xnode_g(k-1,i); Ynode_g(k,i) = Ynode_g(k-1,i); end if num_zero ~= N Xnode_g(k,i) = sum(lx(i,:,k))/(N-num_zero); Ynode_g(k,i) = sum(ly(i,:,k))/(N-num_zero); end
16、 %粒子群補(bǔ)全N個(gè) if num_zero == N for j = 1:N lx(i,j,k) = 0; ly(i,j,k) = 0; end end if num_zero ~= N for j = 1:N if lx(i,j,k) == 0
17、 lx(i,j,k) = Xnode_g(k,i); ly(i,j,k) = Ynode_g(k,i); end end end end %第三種情況 if temp1==0 && temp2~=0 f
18、or j = 1:N sambox1 = [ Xnode_g(k-1,i)-Nf*Vmax]; sambox2 = [ Xnode_g(k-1,i)+Nf*Vmax]; sambox3 = [ Ynode_g(k-1,i)-Nf*Vmax]; sambox4 = [ Ynode_g(k-1,i)+Nf*Vmax]; Xsambox_min(i,j,k) = max(sambox1); Xsam
19、box_max(i,j,k) = min(sambox2); Ysambox_min(i,j,k) = max(sambox3); Ysambox_max(i,j,k) = min(sambox4); and = [and 0]; else and = [and 1];
20、 end end ns = ns+1; end %進(jìn)行最終的判斷 and = []; for m = 1:temp2 d1(m) = sqrt((lx(i,j,k)-Xseed(k,A2(m)))^2+(ly(i,j,k)-Yseed(k,A2(m)))^2); if d1(m)>t
21、r && d1(m)<=2*tr and = [and 0]; else and = [and 1]; end end if sum(and)~=0 lx(i,j,k) = 0; ly(i,j,k) = 0; end
22、 end %至此 節(jié)點(diǎn) i 的粒子群已經(jīng)得到 %下面是進(jìn)行定位,粒子群的優(yōu)化 num_zero = 0; for j = 1:N if lx(i,j,k) == 0 num_zero = num_zero+1; end end %k時(shí)刻的定位位置
23、 if num_zero == N Xnode_g(k,i) = Xnode_g(k-1,i); Ynode_g(k,i) = Ynode_g(k-1,i); end if num_zero ~= N Xnode_g(k,i) = sum(lx(i,:,k))/(N-num_zero); Ynode_g(k,i) = sum(ly(i,:,k))/(N-num_zero);
24、 end %粒子群補(bǔ)全N個(gè) if num_zero == N for j = 1:N lx(i,j,k) = 0; ly(i,j,k) = 0; end end if num_zero ~= N for j = 1:N if lx(i,j,k) == 0
25、 lx(i,j,k) = Xnode_g(k,i); ly(i,j,k) = Ynode_g(k,i); end end end end %第四種情況 if temp1~=0 && temp2~=0 for j = 1:N
26、 sambox1 = [ Xnode_g(k-1,i)-Nf*Vmax]; sambox2 = [ Xnode_g(k-1,i)+Nf*Vmax]; sambox3 = [ Ynode_g(k-1,i)-Nf*Vmax]; sambox4 = [ Ynode_g(k-1,i)+Nf*Vmax]; Xsambox_min(i,j,k) = max(sambox1); Xsambox_max(i,j,k) =
27、min(sambox2); Ysambox_min(i,j,k) = max(sambox3); Ysambox_max(i,j,k) = min(sambox4); %從采樣盒子里采樣 lx(i,j,k) = unifrnd(Xsambox_min(i,j,k),Xsambox_max(i,j,k),1,1); ly(i,j,k) = unifrnd(Ysambox_min(i,j,k),
28、Ysambox_max(i,j,k),1,1); ns = 1; %濾波 and = []; for m = 1:temp1 d1(m) = sqrt((lx(i,j,k)-Xseed(k,A1(m)))^2+(ly(i,j,k)-Yseed(k,A1(m)))^2); if d1(m)<=tr and = [and 0];
29、 end if d1(m)<=tr and = [and 0]; end if d1(m)>tr and = [and 1]; end d1(m) = sqrt((lx(i,j,k)-Xseed(k,A2(m)))^2+(ly(i,j,
30、k)-Yseed(k,A2(m)))^2); if d1(m)>tr && d1(m)<=2*tr and = [and 0]; else and = [and 1]; end end if sum(and)~=0 lx(i
31、,j,k) = 0; ly(i,j,k) = 0; end end %至此 節(jié)點(diǎn) i 的粒子群已經(jīng)得到 %下面是進(jìn)行定位,粒子群的優(yōu)化 num_zero = 0; for j = 1:N if lx(i,j,k) == 0 num_zero = num_zero+1;
32、 end end %k時(shí)刻的定位位置 if num_zero == N Xnode_g(k,i) = Xnode_g(k-1,i); Ynode_g(k,i) = Ynode_g(k-1,i); end if num_zero ~= N Xnode_g(k,i) = sum(lx(i,:,k))/(N-num_zero);
33、 Ynode_g(k,i) = sum(ly(i,:,k))/(N-num_zero); end %粒子群補(bǔ)全N個(gè) if num_zero == N for j = 1:N lx(i,j,k) = 0; ly(i,j,k) = 0; error_total(k) = sum(error(k,:))/Nn; end k = 1:size(error_total,2) plot(k,error_total,'b-o');
- 溫馨提示:
1: 本站所有資源如無(wú)特殊說(shuō)明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請(qǐng)下載最新的WinRAR軟件解壓。
2: 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請(qǐng)聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
3.本站RAR壓縮包中若帶圖紙,網(wǎng)頁(yè)內(nèi)容里面會(huì)有圖紙預(yù)覽,若沒(méi)有圖紙預(yù)覽就沒(méi)有圖紙。
4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
5. 裝配圖網(wǎng)僅提供信息存儲(chǔ)空間,僅對(duì)用戶上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理,對(duì)用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對(duì)任何下載內(nèi)容負(fù)責(zé)。
6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請(qǐng)與我們聯(lián)系,我們立即糾正。
7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時(shí)也不承擔(dān)用戶因使用這些下載資源對(duì)自己和他人造成任何形式的傷害或損失。
最新文檔
- 110中國(guó)人民警察節(jié)(筑牢忠誠(chéng)警魂感受別樣警彩)
- 2025正字當(dāng)頭廉字入心爭(zhēng)當(dāng)公安隊(duì)伍鐵軍
- XX國(guó)企干部警示教育片觀后感筑牢信仰之基堅(jiān)守廉潔底線
- 2025做擔(dān)當(dāng)時(shí)代大任的中國(guó)青年P(guān)PT青年思想教育微黨課
- 2025新年工作部署會(huì)圍繞六個(gè)干字提要求
- XX地區(qū)中小學(xué)期末考試經(jīng)驗(yàn)總結(jié)(認(rèn)真復(fù)習(xí)輕松應(yīng)考)
- 支部書(shū)記上黨課筑牢清廉信念為高質(zhì)量發(fā)展?fàn)I造風(fēng)清氣正的環(huán)境
- 冬季消防安全知識(shí)培訓(xùn)冬季用電防火安全
- 2025加強(qiáng)政治引領(lǐng)(政治引領(lǐng)是現(xiàn)代政黨的重要功能)
- 主播直播培訓(xùn)直播技巧與方法
- 2025六廉六進(jìn)持續(xù)涵養(yǎng)良好政治生態(tài)
- 員工職業(yè)生涯規(guī)劃方案制定個(gè)人職業(yè)生涯規(guī)劃
- 2024年XX地區(qū)黨建引領(lǐng)鄉(xiāng)村振興工作總結(jié)
- XX中小學(xué)期末考試經(jīng)驗(yàn)總結(jié)(認(rèn)真復(fù)習(xí)輕松應(yīng)考)
- 幼兒園期末家長(zhǎng)會(huì)長(zhǎng)長(zhǎng)的路慢慢地走