1. 程式人生 > >卡爾曼濾波(一)

卡爾曼濾波(一)

舉個例子,上一時刻房間溫度最優值為26度,由於溫度變化緩慢,則可以根據經驗估計本次溫度也為26度,即四式右邊第一項,而此時溫度計讀數為28度,那麼本時刻溫度應該是多少?不知道溫度計精度的情況下,可以對兩個資料求平均,為27度,即T=26+0.5*28-26=27。這裡0.5就是本例子中的修正係數,那麼假如溫度計精度很高,將修正係數增大一些,比如增大到0.9,那麼結果T=26+0.9*28-26=27.8,可以看到濾波結果很接近溫度計讀數,增大到1則濾波結果就是溫度計讀數,相反,如果溫度計精度很差,那麼減小修正係數,則可以使濾波結果更接近等式右邊第一項得估計值。因此,合理調整K的大小,可以得到很好的濾波結果,卡爾曼的精髓就在於,能夠動態調整
K的大小,得到最優的估計解。