【圖文】卡爾曼濾波算法(含詳細(xì)推導(dǎo))_第1頁
【圖文】卡爾曼濾波算法(含詳細(xì)推導(dǎo))_第2頁
【圖文】卡爾曼濾波算法(含詳細(xì)推導(dǎo))_第3頁
【圖文】卡爾曼濾波算法(含詳細(xì)推導(dǎo))_第4頁
【圖文】卡爾曼濾波算法(含詳細(xì)推導(dǎo))_第5頁
已閱讀5頁，還剩6頁未讀， 繼續(xù)免費閱讀

下載本文檔

版權(quán)說明：本文檔由用戶提供并上傳，收益歸屬內(nèi)容提供方，若內(nèi)容存在侵權(quán)，請進(jìn)行舉報或認(rèn)領(lǐng)

文檔簡介

1、 若定義 x(n 是利用已知的y(1,y(n求得的狀態(tài)向量的濾波估計，則 Ù Ù 3、kalman濾波算法 e(n = x(n - x1 (n. . . . .( 34 定義濾波狀態(tài)向量的誤差向量，可以證明： P(n= Ee(neH (n . . . .( 35 因此，Riccati差分方程中的矩陣P(n事實上是濾波誤差狀態(tài)向量的相關(guān)矩陣。 （4）、kalman濾波算法 將上面推導(dǎo)得到的式(28、(16、(13、(25、(33和(32依次加以歸納，得 到基于一步預(yù)測的kalman自適應(yīng)濾波算法如下。 初始條件： Ù x1 (1 = Ex(1 K (1,0 = E

2、x(1 - x(1x(1 - x(1H , 其中x(1 = Ex(1 輸入觀測向量過程： 觀測向量=y(1,y(n 已知參數(shù)： 狀態(tài)轉(zhuǎn)移矩陣F(n+1,n 觀測矩陣C(n 過程噪聲向量的相關(guān)矩陣Q1(n 觀測噪聲向量的相關(guān)矩陣Q2(n 計算：n=1,2,3, Ù 3、kalman濾波算法 G(n = F (n + 1, n K (n, n -1C H (nC(nK (n, n -1C H (n + Q2 (n-1. .(36a a (n = y(n - C (n x1 (n. . . . . .( 36b e(n = x(n. - x (n. . . . .( 34 Ù &

3、#217; x1 (n + 1 = F (n + 1, n x1 (n + G(na (n. . . . .(36c Ù 1 P(n = K (n, n -1 - F -1 (n + 1, nG(nC(n K (n, n -1. . .( 36d K (n + 1, n = F (n + 1, n P(n F H (n + 1, nQ1 (n. . .( 36e Ù 3、kalman濾波算法 Kalman濾波器是一種線性的離散時間有限維系統(tǒng)。 Kalman濾波器的估計性能是：它使濾波后的狀態(tài)估計誤差 的相關(guān)矩陣P(n的跡最小化。這意味著，kalman濾波器是 狀態(tài)向量x(n的線性最小差估計。 由前面的公式可以得出kalman濾波算法的結(jié)構(gòu)圖，如下： 3、kalman濾波算法 y( n Å - Ù a ( n G( n Å x1 ( n + 1 Ù z

溫馨提示

  • 1. 本站所有資源如無特殊說明，都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請下載最新的WinRAR軟件解壓。
  • 2. 本站的文檔不包含任何第三方提供的附件圖紙等，如果需要附件，請聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
  • 3. 本站RAR壓縮包中若帶圖紙，網(wǎng)頁內(nèi)容里面會有圖紙預(yù)覽，若沒有圖紙預(yù)覽就沒有圖紙。
  • 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
  • 5. 人人文庫網(wǎng)僅提供信息存儲空間，僅對用戶上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理，對用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯，并不能對任何下載內(nèi)容負(fù)責(zé)。
  • 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容，請與我們聯(lián)系，我們立即糾正。
  • 7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時也不承擔(dān)用戶因使用這些下載資源對自己和他人造成任何形式的傷害或損失。

評論

0/150

提交評論