【摘 要】卡爾曼濾波器是一種線性、遞歸的估值方法,在多領(lǐng)域,尤其在導(dǎo)航領(lǐng)域得到了非常廣泛的應(yīng)用,當(dāng)前己成功應(yīng)用于GPS/INS組合導(dǎo)航,提高了一定的精度。本文利用MATLAB實現(xiàn)卡爾曼濾波器濾波器。仿真結(jié)果表明基于MATLAB設(shè)計的卡爾曼濾波器的濾波效果良好,觀察噪聲越小,系統(tǒng)噪聲越大,遞推次數(shù)越多,卡爾曼濾波器校正作用越好。
【關(guān)鍵詞】卡爾曼濾波器 MATLAB 算法流程 噪聲
Kalman在20世紀(jì)60年代提出卡爾曼濾波理論,之后很多人都很感興趣,許多學(xué)者紛紛對卡爾曼濾波理論進(jìn)行了詳盡的研究和探討。就實現(xiàn)形式而言,卡爾曼濾波器實質(zhì)上就是一套有數(shù)字計算機(jī)實現(xiàn)的遞推更新,每個遞歸周期都包含兩個過程,第一個過程需要進(jìn)行狀態(tài)更新;另一個過程是量測更新。狀態(tài)更新基于狀態(tài)轉(zhuǎn)移方程,對系統(tǒng)狀態(tài)量進(jìn)行時間預(yù)測;量測更新則在狀態(tài)跟新的基礎(chǔ)上根據(jù)實時獲得的觀察值確定。因而,卡爾曼濾波器的輸入和輸出之間就有狀態(tài)更新和觀察量更新的一種算法。
一、卡爾曼濾波算法
四、結(jié)論
從仿真波形可推斷:若觀測值越大,增益越小,觀測數(shù)據(jù)越不可靠,校正就弱;當(dāng)系統(tǒng)噪聲強(qiáng)度增大,狀態(tài)協(xié)方差增大,卡爾曼濾波器增益也增大,也就是說系統(tǒng)的不確定性增強(qiáng),校正作用就大;增加迭代次數(shù),遞推次數(shù)就大,則卡爾曼濾波器的估計值越接近真實值,校正作用就越好,這卡爾曼濾波算法理論值相一致。仿真波形結(jié)合理論,經(jīng)分析可知,MATLAB軟件設(shè)計的卡爾曼濾波器較好地與理論值相一致,濾波效果顯著。
【參考文獻(xiàn)】
[1]秦永元,張洪鉞,汪叔華.卡爾曼濾波與組合導(dǎo)航原理[M].西安:西北工業(yè)大學(xué)出版社,1998
[2]沈云峰,朱海.量測噪聲自動加權(quán)Kalman濾波[J].中國慣性技術(shù)學(xué)報,2001,9(4):21-27