Kalman濾波在信號(hào)跟蹤預(yù)測(cè)中應(yīng)用ppt課件

1、Kalman濾波在信號(hào)跟蹤預(yù)測(cè)中的運(yùn)用 成員：石燕輝 柴延澤 閆洪吉 鄭強(qiáng)Kalman濾波在雷達(dá)數(shù)據(jù)處置中的運(yùn)用雷達(dá)數(shù)據(jù)處置就是雷達(dá)探測(cè)到目的后，提取目的位置信息所構(gòu)成的點(diǎn)跡數(shù)據(jù)，經(jīng)預(yù)處置后，新的點(diǎn)跡與已存在的航跡進(jìn)展數(shù)據(jù)關(guān)聯(lián)，關(guān)聯(lián)上的點(diǎn)跡用來(lái)更新航跡信息，并構(gòu)成對(duì)目的下一位置的預(yù)測(cè)波門(mén)，沒(méi)有關(guān)聯(lián)上的點(diǎn)跡進(jìn)展新航跡起始。雷達(dá)數(shù)據(jù)處置的關(guān)鍵技術(shù)是航跡的起始與終止、跟蹤濾波、數(shù)據(jù)關(guān)聯(lián)。跟蹤濾波的目的是根據(jù)已獲得的目的觀測(cè)數(shù)據(jù)對(duì)目的的形狀進(jìn)展準(zhǔn)確估計(jì)，跟蹤濾波的關(guān)鍵是對(duì)機(jī)動(dòng)目的的跟蹤才干，機(jī)動(dòng)目的跟蹤的主要困難在于跟蹤設(shè)定的目的模型與實(shí)踐的目的動(dòng)力學(xué)模型的匹配問(wèn)題。主要討論內(nèi)容：雷達(dá)數(shù)據(jù)處置中的跟蹤

2、濾波 目的模型CV模型假設(shè)目的以恒定的速度在運(yùn)動(dòng)，那么可得其形狀方程 式中 是零均值、協(xié)方差陣為 的高斯隨機(jī)序列，且 kGWkXkX1 kW)()()()()(kykykxkxkX10001000010001TT102/00102/TTG21wwWQ kjQjWkWE目的模型CV模型觀測(cè)方程 式中 為零均值、協(xié)方差為 的白噪聲，且與 不相關(guān) kVkHXkZ01000001HVRW目的模型CA模型假設(shè)目的一恒定的加速度在運(yùn)動(dòng)，那么其形狀方程 式中 是零均值、方差陣為 的高斯隨機(jī)序列，且)()() 1(kkkWGXXmmmmmyxyyxxXmmmmmmm 100000010000010002/01

3、000001002/00122TTTTTTm10012/04/002/02/2222TTTTGm kWQ kjQjWkWE目的模型CA模型觀測(cè)方程 式中 為零均值、協(xié)方差為 的白噪聲，且與 不相關(guān) kVkXHkZmmmm000000100001mHmVRmWKalman濾波根底預(yù)測(cè)預(yù)測(cè)協(xié)方差Kalman增益濾波濾波協(xié)方差) 1/1() 1/(kkXkkX)() 1/1() 1/(kQkkPkkPT)() 1/() 1/()(1kRHkkHPHkkPkKTT) 1/()()() 1/()/(kkXHkZkKkkXkkX 1kkPHkKIkkP非機(jī)動(dòng)模型的Kalman濾波當(dāng)目的做非機(jī)動(dòng)運(yùn)動(dòng)，即勻速

4、直線運(yùn)動(dòng)時(shí)，采用根本的濾波與預(yù)測(cè)方法，如：Kalman濾波，即可j較好的跟蹤目的。Kalman濾波算法原理根本思想：Kalman濾波是根據(jù)前一次的估計(jì)值和當(dāng)前的觀測(cè)值，用形狀方程和遞推方法來(lái)估計(jì)非平穩(wěn)隨機(jī)信號(hào)的波形，其解以估計(jì)值的形式給出。假設(shè)，觀測(cè)模型：形狀模型：非機(jī)動(dòng)模型的初始化：在運(yùn)用Kalman濾波算法時(shí)，需求制定濾波的初始條件，實(shí)際上初始條件是根據(jù)目的的初始形狀來(lái)建立的。而在實(shí)踐中，通常目的的初始形狀是未知的，但我們可以利用前幾個(gè)觀測(cè)值建立形狀的初始估計(jì)。非機(jī)動(dòng)模型只需思索目的位置和速度的形狀估計(jì)，利用其前兩個(gè)觀測(cè)值建立初始估計(jì)，即進(jìn)而得到初始估計(jì)的估計(jì)誤差：和初始估計(jì)的估計(jì)誤差協(xié)方

5、差： kkkVHXZ kkkWXX1 1221222|2yyyxxxzzzzzzX 2|222|2XXX2|22|22|2XXPKalman濾波遞推過(guò)程與流圖根據(jù)前一次形狀估計(jì)值，計(jì)算預(yù)測(cè)值根據(jù)新的觀測(cè)值得新息根據(jù)前一次得到的濾波誤差協(xié)方差，計(jì)算預(yù)測(cè)誤差方差計(jì)算濾波增益得到當(dāng)前時(shí)辰形狀最正確估計(jì)5. 得到當(dāng)前時(shí)辰濾波誤差協(xié)方差 6. 將4，5得到的結(jié)果作為初始估計(jì)，開(kāi)場(chǎng)下一輪遞推。1| kkP kKkk |P1| 1kkP kQ kR1kk1| kkXkk |X1| 1kkX kV1kk1| 11|kkkkXX 1|kkkkXHZv11, 11|kkkkkQPP kkkkv11|PHPK 11

6、|1|kkkkkRHHPHP kkkkkkvKXX1| 1|kkkkkPHKIPKalman濾波遞推流圖Monte Carlo 仿真 Monte Carlo仿真方法又稱統(tǒng)計(jì)實(shí)驗(yàn)法，其根本思想是首先建立與描畫(huà)該問(wèn)題有類似性的概率模型，然后對(duì)模型進(jìn)行隨機(jī)模擬或統(tǒng)計(jì)抽樣，再利用所得的結(jié)果求出特征量的統(tǒng)計(jì)估計(jì)值作為原問(wèn)題的近似解，并對(duì)解的精度做出某些估計(jì)。其主要實(shí)際根底是概率論中的大數(shù)定理。 對(duì)于目的跟蹤系統(tǒng)，Monte Carlo仿真方法借助大量的計(jì)算機(jī)模擬來(lái)檢驗(yàn)?zāi)康男盘?hào)的統(tǒng)計(jì)特性，然后歸納出統(tǒng)計(jì)結(jié)果目的軌跡估計(jì)，并對(duì)其精度做出估計(jì)目的跟蹤誤差的均值或規(guī)范差。因此，它可以作為評(píng)價(jià)跟蹤系統(tǒng)性能的根本方

7、法。非機(jī)動(dòng)模型Kalman濾波實(shí)例未采用未采用Monte Carlo仿真仿真采用采用Monte Carlo仿真仿真目的運(yùn)動(dòng)軌跡與其估計(jì)值目的位置估計(jì)誤差目的運(yùn)動(dòng)軌跡與其估計(jì)值目的位置估計(jì)誤差均值Kalman濾波的發(fā)散景象發(fā)散景象及緣由 普通的講，按照Kalman濾波實(shí)際，隨著觀測(cè)次數(shù)的添加，Kalman濾波的均方誤差應(yīng)該逐漸減小而最終趨于一個(gè)穩(wěn)態(tài)值。但在實(shí)踐運(yùn)用中，有時(shí)形狀濾波的均方誤差會(huì)隨著觀測(cè)次數(shù)的添加而增大，即濾波發(fā)散。引起濾波發(fā)散的主要緣由可歸納為以下兩點(diǎn)：1. 系統(tǒng)模型不準(zhǔn)確，即模型誤差；2. 計(jì)算誤差，如有限字長(zhǎng)效應(yīng)。抑制發(fā)散景象的措施和方法1. 選擇適宜的信號(hào)模型；2. 自順應(yīng)濾

8、波方法；3. 漸消記憶濾波法和限定記憶濾波法；4. 限定增益下限法；5. 限制誤差協(xié)方差法。基于蒙特卡洛仿真的變維(VD)濾波算法VD算法根本思想算法根本思想 非機(jī)動(dòng)時(shí)采用低階的非機(jī)動(dòng)時(shí)采用低階的Kalman濾波器，而機(jī)濾波器，而機(jī)動(dòng)時(shí)采用高階模型的動(dòng)時(shí)采用高階模型的Kalman濾波器，用機(jī)濾波器，用機(jī)動(dòng)檢測(cè)器來(lái)監(jiān)視機(jī)動(dòng)。動(dòng)檢測(cè)器來(lái)監(jiān)視機(jī)動(dòng)。一旦監(jiān)測(cè)到機(jī)動(dòng)，模型一旦監(jiān)測(cè)到機(jī)動(dòng)，模型立刻由低階轉(zhuǎn)至高階，立刻由低階轉(zhuǎn)至高階，其關(guān)鍵是機(jī)動(dòng)檢測(cè)器的其關(guān)鍵是機(jī)動(dòng)檢測(cè)器的設(shè)計(jì)及模型由低階向高設(shè)計(jì)及模型由低階向高階轉(zhuǎn)換時(shí)，濾波器的重階轉(zhuǎn)換時(shí)，濾波器的重新初始化問(wèn)題。新初始化問(wèn)題。初值的設(shè)定k=1非機(jī)動(dòng)模型跟

9、蹤(k)T1k=k+1Yj=k-1N初值的重設(shè)定機(jī)動(dòng)模型跟蹤 T2ak=k+1NY機(jī)動(dòng)檢測(cè)過(guò)程l濾波器開(kāi)場(chǎng)任務(wù)于正常方式，其輸出的新息序列為 ,令l l 是 的協(xié)方差矩陣，取 作為檢測(cè)機(jī)動(dòng)的有效窗口長(zhǎng)度，假設(shè)l l l 那么以為目的在 開(kāi)場(chǎng)有一恒定的加速度參與，這時(shí)目的模型由非機(jī)動(dòng)模型轉(zhuǎn)向機(jī)動(dòng)模型。l由機(jī)動(dòng)模型退回到低階非機(jī)動(dòng)模型的檢測(cè)方法是檢測(cè)加速度估計(jì)值能否有統(tǒng)計(jì)顯著l 性意義。令l 其中 是加速度分量的估計(jì)值， 是協(xié)方差矩陣的子矩陣塊，l 假設(shè)l l l 那么加速度估計(jì)無(wú)顯著意義，濾波器退出機(jī)動(dòng)模型。l kka jjajjpjjakmakpkja11( / )maP k k)()()()

10、1()(1kvkSkvkakhTk )(aaTk )( kS kv11 kv1k模型重新初始化l在k-的加速l 度估計(jì)為 l在k-的位置估計(jì)為l在k-的速度估計(jì)為122kkzkzkkaxxmxkzkkykzkkxymxm,122kkzkzkkayymykkakkvkkvmxmxmx11kkakkvkkvmymymy11VD算法仿真分析跟蹤結(jié)果及誤差規(guī)范差分析基于蒙特卡洛仿真的交互多模(IMM)算法假定有r個(gè)模型其中， 是均值為零、協(xié)方差矩陣為 的白噪聲序列。用一個(gè)馬爾可夫鏈來(lái)控制這些模型之間的轉(zhuǎn)換，馬爾可夫鏈的轉(zhuǎn)移概率矩陣為 丈量模型為 rjkWGkXkXjjj, 1,1 kWjjQrrrrp

11、pppP1111 kVkXHkZjjj基于蒙特卡洛仿真的交互多模(IMM)算法2MX模型初始化模型初始化輸入交互輸入交互各模型及其它的計(jì)算各模型及其它的計(jì)算k=N?YN輸出交互輸出交互End1MXrMXIMM算法的根本思想 在每一時(shí)辰，假設(shè)某個(gè)模型在如今時(shí)辰有效的條件下，經(jīng)過(guò)混合前一時(shí)辰一切濾波器的形狀估計(jì)值來(lái)獲得與這個(gè)特定模型匹配的濾波器的初始條件；然后對(duì)每個(gè)模型并行實(shí)現(xiàn)正規(guī)濾波(預(yù)測(cè)與修正)步驟；最后，以模型匹配似然函數(shù)為根底更新模型概率，并組合一切濾波器修正后的形狀估計(jì)值(加權(quán)和)以得到形狀估計(jì)交互多模(IMM)算法的遞推步驟1 模型條件初始化混合概率 其中混合估計(jì)(輸入交互)rjkkk

12、kXkkXijriij, 1,11111110111111111111110010kkXkkXkkXkkXkkPkkkkPjijiiriijj jiijkjiijckpZkMkMpkk1,1111riiijjkpc11交互多模(IMM)算法的遞推步驟2 模型條件濾波形狀預(yù)測(cè)量測(cè)預(yù)測(cè)殘差及其協(xié)方差陣計(jì)算 似然函數(shù)濾波更新1110kkXkkXjjjjjjjjjjGQGkkPkkP1110 1kkXHkZkvj RHkkHPkSjj1 jjjjkjvSvkSZkMkZPk121121exp2, 111RHkkHPHkkPkKjjj 11kkXHkZkKkkXkkXjjjj 1kkPkKIkkPjjj交互多模(IMM)算法的遞推步驟3 模型概率更新其中 4 估計(jì)交融(輸出交互) cc