kalman濾波簡介-資料下載頁
2025-08-05 00:46本頁面
【正文】 2/8/23 就實現(xiàn)形式而言，卡爾曼濾波器實質(zhì)上是一套由數(shù)字討算機 實現(xiàn)的遞推算法 .每個遞推周期中包含對被估計量的時間更新 和量測更新兩個過程。時間更新由上一步的量測更新結(jié)果和 設(shè)計卡爾曼濾波器時的先驗信息確定，量測更新則在時間更 新的基礎(chǔ)上根據(jù)實時獲得的量測值確定。因此。量測量可看 做卡爾曼濾波器的輸入，估計值可看做輸出，輸入與輸出之 間由時間更新和量測更新算法聯(lián)系，這與數(shù)字信號處理概念 是類似的，所以有些書稱卡爾曼濾波為廣義數(shù)字信號處理。 北京理工大學 北京理工大學 31 2022/8/23 Kalman濾波算法框圖 北京理工大學 北京理工大學 32 2022/8/23 0 ,1Pk?1kQ?kR1, 1 , 1[]TTk k k k k k k k kK P H H P H R ?????,1, 1 , 1 1 , 1 , 1 1 kkTTk k k k k k k k k kP P Q?? ? ? ? ? ?? ? ? ? ? ?,1[]k k k k kP I K H P ???1kk??0? ,1Xk?, 1 , 1 1? ?k k k k kXX? ? ???, 1 , 1? ? ?[]k k k k k k k kX X K Z H X??? ? ?kZ北京理工大學 北京理工大學 33 2022/8/23 , 1 , 1 1? ?k k k k kXX? ? ???1, 1 , 1[]TTk k k k k k k k kK P H H P H P ?????, 1 , 1? ? ?[]k k k k k k k kX X K Z H X??? ? ?,1[ ] [ ] kTTk k k k k k k k kP I K H P I K H K R K?? ? ? ?,1, 1 , 1 1 , 1 , 1 1 kkTTk k k k k k k k k kP P Q?? ? ? ? ? ?? ? ? ? ? ?仿真效果 北京理工大學 北京理工大學 34 2022/8/23 對于前面房間溫度的例子，根據(jù)前面的描述，把房間看成一個 系統(tǒng)，然后對這個系統(tǒng)建模。當然，我們見的模型不需要非常 地精確。我們所知道的這個房間的溫度是跟前一時刻的溫度相 同的，所以 。沒有控制量，所以 U(k)=0 。 因為測量的值是溫度計的，跟溫度直接對應(yīng)，所以 假設(shè) 。得到式子 ,1 1kk???1kH ?,1 1kk???? ?? ?11 1*2*k k kk k kX X WZ X V?????? ???北京理工大學 北京理工大學 35 2022/8/23 ? ?, 1 1? ? 1k k kXX ???? ?, 1 , 1? ? ?[ ] 2k k k k k k kX X K Z X??? ? ?? ?1, 1 , 1[ ] 3k k k k k kK P P P ?????? ?, 1 1 1 4k k k kP P Q? ? ???? ?,1[ ] [ ] 5kTTk k k k k k kP I K P I K K R K?? ? ? ?北京理工大學 北京理工大學 36 2022/8/23 現(xiàn)在我們模擬一組測量值作為輸入。假設(shè)房間的真實溫度為 25 度，模擬了 200個測量值，這些測量值的平均值為 25度，但是 加入了標準偏差為幾度的高斯白噪聲 (在圖中為藍線 )。 為了令卡爾曼濾波器開始工作，我們需要告訴卡爾曼兩個零時 刻的初始值，是 X0和 P0。它們的值不用太在意，隨便給一個就 可以了，因為隨著卡爾曼的工作， X會逐漸的收斂。但是對于 P，一般不要取 0，因為這樣可能會令卡爾曼完全相信你給定的 X0 是系統(tǒng)最優(yōu)的，從而使算法不能收斂。選了 X0=1度， P0=10。 該系統(tǒng)的真實溫度為 25度，圖中用黑線表示。圖中紅線是卡爾 曼濾波器輸出的最優(yōu)化結(jié)果 (該結(jié)果在算法中設(shè)置了 Q=le6 R=le1)。 北京理工大學 北京理工大學 37 2022/8/2
范文總結(jié)相關(guān)推薦
鄂ICP備17016276號-1