(二). 細說Kalman濾波:The Kalman Filter

本文為原創(chuàng)文章,轉(zhuǎn)載請注明出處,http://www.cnblogs.com/ycwang16/p/5999034.html

前面介紹了Bayes濾波方法,我們接下來詳細說說Kalman濾波器。雖然Kalman濾波器已經(jīng)被廣泛使用,也有很多的教程,但我們在Bayes濾波器的框架上,來深入理解Kalman濾波器的設計,對理解采用Gaussian模型來近似狀態(tài)分布的多高斯濾波器(Guassian Multi-Hyperthesis-Filter)等都有幫助。

一. 背景知識回顧

1.1 Bayes濾波

首先回顧一下Bayes濾波. Bayes濾波分為兩步:1.狀態(tài)預測;和 2.狀態(tài)更新

1. 狀態(tài)預測,基于狀態(tài)轉(zhuǎn)移模型:

belˉˉˉˉˉˉ(xt)=∫p(xt|ut,xt?1)bel(xt?1)dxt?1belˉ(xt)=∫p(xt|ut,xt?1)bel(xt?1)dxt?1

2. 狀態(tài)更新,基于新的觀測

bel(xt)=ηp(zt|xt)belˉˉˉˉˉˉ(xt)bel(xt)=ηp(zt|xt)belˉ(xt)

我們可以看到,我們的目的是計算xtxt的后驗概率,如果bel(xt)bel(xt)是任意分布,我們需要在xtxt的所有可能取值點上,計算該取值的概率,這在計算上是難于實現(xiàn)的。這一計算問題可以有多種方法來近似,比如利用采樣的方法,就是后面要講的粒子濾波和無跡Kalman濾波。

這節(jié)要說的近似方法是,當假設bel(xt)bel(xt)服從Gauss分布,那么我們只需要分布的均值和方差就可以完全描述

網(wǎng)友評論