基于AVR單片機(jī)的自由立體顯示背光控制系統(tǒng)

作者：時(shí)間：2012-03-13 來源：網(wǎng)絡(luò)

加入技術(shù)交流群
- 掃碼加入
  和技術(shù)大咖面對(duì)面交流
  海量資料庫查詢

1．2 基于 單片機(jī)的Kalman濾波的預(yù)測(cè)實(shí)現(xiàn)
Kalman信號(hào)模型包括狀態(tài)方程和測(cè)量方程。狀態(tài)方程描述了系統(tǒng)當(dāng)前狀態(tài)和前一狀態(tài)的狀態(tài)轉(zhuǎn)移關(guān)系。如下所示：

平穩(wěn)條件下，Q，R是恒定的。Kalman濾波的過程就是根據(jù)觀測(cè)值和信號(hào)模型恢復(fù)出原始信號(hào)的過程。
濾波器的輸出由式（4）給出：

式中：

稱為測(cè)量過程的革新或殘余，它代表了預(yù)期的測(cè)量值和實(shí)際測(cè)量值之間的誤差；K是增益因子，用于最小化后驗(yàn)均方誤差，在濾波過程中會(huì)動(dòng)態(tài)發(fā)生改變，如果測(cè)量更準(zhǔn)確K將越大，模型估計(jì)越準(zhǔn)確K越小。K的值和模型估計(jì)誤差P相關(guān)聯(lián)，K和P由下面式子迭代算出。

式(5)，式(6)為Kalman濾波的預(yù)測(cè)階段，使用上一狀態(tài)的估計(jì)，做出對(duì)當(dāng)前狀態(tài)的估計(jì)。式(7)～(9)為Kalman濾波的更新階段，利用對(duì)當(dāng)前狀態(tài)的觀測(cè)值優(yōu)化在預(yù)測(cè)階段獲得的預(yù)測(cè)值，以獲得一個(gè)更精確的濾波值。
Kalman濾波預(yù)測(cè)跟蹤有一個(gè)啟動(dòng)過程，經(jīng)過若干次迭代后。Kalman濾波才會(huì)趨于穩(wěn)定。在該系統(tǒng)中，采用勻速直線運(yùn)動(dòng)模型，狀態(tài)方程為：