基于粒子濾波的TBD算法仿真----MATLAB仿真

原文鏈接:https://blog.xxcxw.cn/2019/08/10/%e5%9f%ba%e4%ba%8e%e7%b2%92%e5%ad%90%e6%bb%a4%e6%b3%a2%e7%9a%84tbd%e7%ae%97%e6%b3%95%e4%bb%bf%e7%9c%9f-matlab%e4%bb%bf%e7%9c%9f/

目標(biāo)跟蹤的最終目的是在最小的誤差下確定目標(biāo)的位置爷狈,而在無線傳感器網(wǎng)絡(luò)中要實(shí)現(xiàn)這個目的需要很多相關(guān)技術(shù)的支持,如定位技術(shù)禽绪、目標(biāo)檢測技術(shù)猾骡、估計(jì)技術(shù)、節(jié)能技術(shù)等蚜印。目標(biāo)跟蹤問題的求解有很多方法莺禁, 從算法的考慮方向上來說可以分為兩大類: 自頂向下的算法和自底向上的算法?。自頂向下的目標(biāo)跟蹤算法的核心思想是先對要跟蹤的目標(biāo)進(jìn)行恰當(dāng)?shù)慕#?從模型出發(fā)來實(shí)現(xiàn)跟蹤目的窄赋,狀態(tài)空間方法就是一種典型的自頂向下的方法哟冬。所謂自底向上的方法楼熄, 就是指沒有現(xiàn)成的理論框架, 從實(shí)際問題出發(fā)浩峡、從得到的數(shù)據(jù)出發(fā)來實(shí)現(xiàn)對目標(biāo)的跟蹤可岂。從效果上來看, 兩種方法的跟蹤效果并沒有特別明顯的差異翰灾,但是由于自頂向下的方法有嚴(yán)格的理論框架缕粹, 便于進(jìn)行研究, 本文中主要考慮這種方法纸淮。

無線傳感器網(wǎng)絡(luò)中平斩,在特定的檢測區(qū)域布設(shè)好無線傳感器網(wǎng)絡(luò)后,網(wǎng)絡(luò)先進(jìn)行初始化咽块,對網(wǎng)絡(luò)中所有的節(jié)點(diǎn)?進(jìn)行定位绘面,然后就可以對感興趣的目標(biāo)進(jìn)行跟蹤了。

目標(biāo)跟蹤和檢測的問題描述

對于無線傳感器網(wǎng)絡(luò)中的目標(biāo)跟蹤和檢測問題糜芳, 目標(biāo)的運(yùn)動過程即狀態(tài)轉(zhuǎn)移方程通踌酰可以用一階的馬爾

科夫狀態(tài)方程來描述

式中,?xk?表示?xk -1?時刻的目標(biāo)狀態(tài)向量峭竣, 一般可能包含目標(biāo)的位置塘辅、速度、加速度等信息;?f(?xk -1) 表示目標(biāo)狀態(tài)從?xk -1?時刻到?xk?時刻的狀態(tài)轉(zhuǎn)移函數(shù)( 線性或非線性) ;?wk?表示過程噪聲向量皆撩。相應(yīng)的扣墩, 時刻的觀測方程的一般形式:

式中,?zk?表示?xk?時刻節(jié)點(diǎn)中得到的觀測向量扛吞,?h(?xk) 表示觀測函數(shù)( 線性或非線性) 呻惕,?vk?表示觀測噪聲。過程噪聲和觀測噪聲均是未知的滥比, 且不一定是均值為零的高斯白噪聲亚脆, 但是它們的概率密度一般都是知道的。有了這兩個模型后盲泛, 目標(biāo)跟蹤所要解決的問題就是根據(jù)目標(biāo)之前的狀態(tài)和得到的觀測序列來求解目標(biāo)的當(dāng)前狀態(tài)量濒持。

粒子濾波算法

粒子濾波算法的出現(xiàn)歷時半個多世紀(jì), 最早可以追溯到?20?世紀(jì)四十年代?Metropolis?等人提出的蒙特卡洛方法(?Monte Carlo method)?20?世紀(jì)七十年代?MC?方法首次用于解決非線性濾波問題寺滚, 當(dāng)時使用的是序貫重要性采樣方法: 用一組從建議分布中采樣得到的帶權(quán)值的樣本來近似目標(biāo)狀態(tài)分布柑营,這種方法存在很嚴(yán)重的樣本權(quán)值退化問題,實(shí)際的應(yīng)用非常有限;?1993?年村视,Gordon?等人提出了重采樣的概念[6]?官套,并將重采樣引入到蒙特卡洛重要性采樣過程中有效地解決了樣本權(quán)值退化問題, 開啟了基于蒙特卡洛積分的粒子濾波算法的研究熱潮。經(jīng)過二十多年的研究和發(fā)展奶赔,如今粒子濾波算法已經(jīng)相當(dāng)成熟惋嚎,成為非線性、非高斯系統(tǒng)中的估計(jì)問題最重要的解決方法之一纺阔, 廣泛應(yīng)用于自主導(dǎo)航瘸彤、機(jī)器人視覺和目標(biāo)跟蹤等問題中?修然。

已知目標(biāo)狀態(tài)的初始分布為?p(?x0)?笛钝、它在?k -?1?時刻的后驗(yàn)概率密度分布為?p(?xk -1?z1:?k -1)?=?{?xi k -1,wi k -1}?N i =?1愕宋,結(jié)合重要性采樣和重采樣玻靡, 一般的粒子濾波算法估計(jì)?k時刻的目標(biāo)狀態(tài)向量?xk?的具體步驟如下

(?1) 初始化:?k =?0, 從?p(?x0) 中隨機(jī)抽取?N?個初始粒子 {?x0i?中贝,i =?1囤捻,2,…邻寿,N} 蝎土, 并令每個粒子的初始權(quán)值都為?1?/N。

(?2) 根據(jù)提議分布( 一般使用?SIS?算法绣否, 即取先驗(yàn)概率密度函數(shù)為提議分布) 更新粒子

(?3) 在得到?k?時刻觀測值?zk?后誊涯, 根據(jù)公式計(jì)算每個粒子的權(quán)值

(?4) 重采樣過程, 先根據(jù)公式計(jì)算有效粒子數(shù),執(zhí)行重采樣算法( 如多項(xiàng)式重采樣等) 蒜撮,否則就直接跳到第(?5) 步暴构。

(?5) 根據(jù)蒙特卡洛積分得到?k?時刻目標(biāo)狀態(tài)的估計(jì)值:

(?6) 令?k = k +?1, 得到?k +?1?時刻的觀測值后轉(zhuǎn)到步驟(?2) 段磨,直到結(jié)束取逾。

仿真結(jié)果

文檔下載:鏈接:https://pan.baidu.com/s/1IOwb2cOw3A2tvlTboVa88g

提取碼:p7a1

程序下載:鏈接:https://pan.baidu.com/s/1XA42i4oYesMWayf5ts3fWA

提取碼:juo7

解碼密碼獲取:http://t.cn/AiTjdQZq

?著作權(quán)歸作者所有,轉(zhuǎn)載或內(nèi)容合作請聯(lián)系作者
  • 序言:七十年代末苹支,一起剝皮案震驚了整個濱河市砾隅,隨后出現(xiàn)的幾起案子,更是在濱河造成了極大的恐慌债蜜,老刑警劉巖晴埂,帶你破解...
    沈念sama閱讀 221,548評論 6 515
  • 序言:濱河連續(xù)發(fā)生了三起死亡事件,死亡現(xiàn)場離奇詭異策幼,居然都是意外死亡邑时,警方通過查閱死者的電腦和手機(jī),發(fā)現(xiàn)死者居然都...
    沈念sama閱讀 94,497評論 3 399
  • 文/潘曉璐 我一進(jìn)店門特姐,熙熙樓的掌柜王于貴愁眉苦臉地迎上來晶丘,“玉大人,你說我怎么就攤上這事∏掣。” “怎么了沫浆?”我有些...
    開封第一講書人閱讀 167,990評論 0 360
  • 文/不壞的土叔 我叫張陵,是天一觀的道長滚秩。 經(jīng)常有香客問我专执,道長,這世上最難降的妖魔是什么郁油? 我笑而不...
    開封第一講書人閱讀 59,618評論 1 296
  • 正文 為了忘掉前任本股,我火速辦了婚禮睛廊,結(jié)果婚禮上夹纫,老公的妹妹穿的比我還像新娘。我一直安慰自己矢渊,他們只是感情好案站,可當(dāng)我...
    茶點(diǎn)故事閱讀 68,618評論 6 397
  • 文/花漫 我一把揭開白布躬审。 她就那樣靜靜地躺著,像睡著了一般蟆盐。 火紅的嫁衣襯著肌膚如雪承边。 梳的紋絲不亂的頭發(fā)上,一...
    開封第一講書人閱讀 52,246評論 1 308
  • 那天石挂,我揣著相機(jī)與錄音博助,去河邊找鬼。 笑死誊稚,一個胖子當(dāng)著我的面吹牛翔始,可吹牛的內(nèi)容都是我干的。 我是一名探鬼主播里伯,決...
    沈念sama閱讀 40,819評論 3 421
  • 文/蒼蘭香墨 我猛地睜開眼城瞎,長吁一口氣:“原來是場噩夢啊……” “哼!你這毒婦竟也來了疾瓮?” 一聲冷哼從身側(cè)響起脖镀,我...
    開封第一講書人閱讀 39,725評論 0 276
  • 序言:老撾萬榮一對情侶失蹤,失蹤者是張志新(化名)和其女友劉穎狼电,沒想到半個月后蜒灰,有當(dāng)?shù)厝嗽跇淞掷锇l(fā)現(xiàn)了一具尸體,經(jīng)...
    沈念sama閱讀 46,268評論 1 320
  • 正文 獨(dú)居荒郊野嶺守林人離奇死亡肩碟,尸身上長有42處帶血的膿包…… 初始之章·張勛 以下內(nèi)容為張勛視角 年9月15日...
    茶點(diǎn)故事閱讀 38,356評論 3 340
  • 正文 我和宋清朗相戀三年强窖,在試婚紗的時候發(fā)現(xiàn)自己被綠了。 大學(xué)時的朋友給我發(fā)了我未婚夫和他白月光在一起吃飯的照片削祈。...
    茶點(diǎn)故事閱讀 40,488評論 1 352
  • 序言:一個原本活蹦亂跳的男人離奇死亡翅溺,死狀恐怖脑漫,靈堂內(nèi)的尸體忽然破棺而出,到底是詐尸還是另有隱情咙崎,我是刑警寧澤优幸,帶...
    沈念sama閱讀 36,181評論 5 350
  • 正文 年R本政府宣布,位于F島的核電站褪猛,受9級特大地震影響网杆,放射性物質(zhì)發(fā)生泄漏。R本人自食惡果不足惜伊滋,卻給世界環(huán)境...
    茶點(diǎn)故事閱讀 41,862評論 3 333
  • 文/蒙蒙 一碳却、第九天 我趴在偏房一處隱蔽的房頂上張望。 院中可真熱鬧新啼,春花似錦追城、人聲如沸。這莊子的主人今日做“春日...
    開封第一講書人閱讀 32,331評論 0 24
  • 文/蒼蘭香墨 我抬頭看了看天上的太陽迷帜。三九已至物舒,卻和暖如春,著一層夾襖步出監(jiān)牢的瞬間戏锹,已是汗流浹背冠胯。 一陣腳步聲響...
    開封第一講書人閱讀 33,445評論 1 272
  • 我被黑心中介騙來泰國打工, 沒想到剛下飛機(jī)就差點(diǎn)兒被人妖公主榨干…… 1. 我叫王不留锦针,地道東北人荠察。 一個月前我還...
    沈念sama閱讀 48,897評論 3 376
  • 正文 我出身青樓,卻偏偏與公主長得像奈搜,于是被迫代替她去往敵國和親悉盆。 傳聞我的和親對象是個殘疾皇子,可洞房花燭夜當(dāng)晚...
    茶點(diǎn)故事閱讀 45,500評論 2 359

推薦閱讀更多精彩內(nèi)容

  • 本文參考博客地址 粒子濾波 粒子濾波的狀態(tài)轉(zhuǎn)移方程和觀測方程如下:其中的x(t)為t時刻狀態(tài)馋吗,u(t)為控制量焕盟,w...
    雨住多一橫閱讀 5,173評論 0 2
  • 多目標(biāo)跟蹤的問題是這樣的:有一段視頻,視頻是由 N 個 連續(xù)幀構(gòu)成的宏粤。從第一幀到最后一幀脚翘,里面有多個目標(biāo),不斷地有...
    Fantesla閱讀 6,467評論 0 9
  • 預(yù)估器 我們希望可以最大限度地使用測量結(jié)果來估計(jì)移動物體的運(yùn)動绍哎。所以来农,多個測量的累積可以讓我們檢測出不受噪聲影響的...
    JasonDing閱讀 6,790評論 4 10
  • 前兩天沒記錄寶寶讀書的情況,但是他經(jīng)常會自主閱讀崇堰。我把所有的書放在箱子里沃于,他每天從幼兒園回到家,(我還沒下班,而爸...
    懶媽閱讀 219評論 0 0
  • 親愛的女兒揽涮,上次圍棋賽贏得了一張永聯(lián)農(nóng)耕園的門票抠藕,我們商量好了今天一起去玩。以前沒去過蒋困,所以今天去覺得一切都很新奇...
    小怪物_a3bf閱讀 121評論 0 4