三種卡爾曼濾波理論_第1頁(yè)
三種卡爾曼濾波理論_第2頁(yè)
三種卡爾曼濾波理論_第3頁(yè)
全文預(yù)覽已結(jié)束

下載本文檔

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

文檔簡(jiǎn)介

1、精選優(yōu)質(zhì)文檔-傾情為你奉上經(jīng)典卡爾曼濾波動(dòng)態(tài)系統(tǒng)的卡爾曼濾波數(shù)學(xué)模型包括狀態(tài)方程和觀測(cè)方程,對(duì)于線性系統(tǒng),其離散形式為Xk= k,k-1Xk-1+ Gk-1Wk-1Lk= HkXk+ Vk其中,Xk為系統(tǒng)在tk時(shí)刻的n×1維狀態(tài)向量,k,k-1為系統(tǒng)從tk-1時(shí)刻到tk時(shí)刻的n×n維狀態(tài)轉(zhuǎn)移矩陣,Wk-1為tk-1時(shí)刻的r×1動(dòng)態(tài)噪聲,Gk-1為tk-1時(shí)刻的n×r動(dòng)態(tài)噪聲矩陣,Lk為系統(tǒng)在tk時(shí)刻的m×1維觀測(cè)向量,Hk為系統(tǒng)在tk時(shí)刻的m×n維觀測(cè)矩陣,Vk為系統(tǒng)在tk時(shí)刻的m×1維觀測(cè)噪聲。根據(jù)最小二乘原則,可推得卡爾

2、曼濾波遞推公式為:1)狀態(tài)向量一步預(yù)測(cè)值為 Xk,k-1=k,k-1 Xk-1,k-12)狀態(tài)向量一步預(yù)測(cè)值方差矩陣為Pk,k-1= k,k-1 Pk-1,k-1k,k-1T+Gk-1Qk-1Gk-1T 其中,Qk為動(dòng)態(tài)噪聲方差矩陣。3)狀態(tài)向量估計(jì)值為Xk,k= Xk,k-1+JkLk- HkXk,k-14)狀態(tài)向量估計(jì)值方差矩陣為Pk,k= I- JkHkPk,k-1其中,Jk為濾波增益矩陣,具體形式如下Jk= Pk,k-1HkTHkPk,k-1HkT+ Rk-1Rk為觀測(cè)噪聲方差矩陣。基于方差補(bǔ)償?shù)淖赃m應(yīng)卡爾曼濾波假定Wk和Vk是正態(tài)序列,X0是正態(tài)向量。則定義l步預(yù)測(cè)殘差是Vk+l=

3、Lk+l- Lk+l,k其中, Lk+l,Lk+l,k分別為第k+l期觀測(cè)值和它的最佳觀測(cè)值Lk+l,k= Hk+lk+l,kXk,k,則Vk+l為正態(tài)向量。Vk+l的方差陣Svv為:Svv= Hk+lk+l,kPkk+l,kTHk+lT+Rk+l+ i=1lHk+lk+l,k+iGk+l,k+i-1Qk+i-1Gk+l,k+i-1Tk+l,k+iTHk+lT記Hk+lk+l,k+iGk+l,k+i-1= Ak+l,k+i= ahjk+l,k+i,式中h=1,2,m;j=1,2,r。假定Qk+i-1在觀測(cè)時(shí)間段tk+1,tk+2,tk+N上為常值對(duì)角陣,即Qk+i-1= 11200rr2=Q并

4、記diagQ= 112,222,rr2T。根據(jù)EVk+lTVk+l=trVk+lVk+lT=trSvv,于是記Vk+lTVk+l=trSvv+ k+l其中,k+l為零均值隨機(jī)變量,l=1,2,N。令Ek+l= Vk+lTVk+l-trHk+lk+l,kPkk+l,kTHk+lT-trRk+l又記E= Ek+l,Ek+NT= k+l,k+NTA= Ak+l,Ak+NT則有E=AdiagQ+ 上式就是關(guān)于diagQ的線性方程組。當(dāng)Nr時(shí),有唯一解。記diagQ的LS估計(jì)為diagQ= ATA-1ATE根據(jù)上面各式求得任意長(zhǎng)度時(shí)間段上的Q,把它作為動(dòng)態(tài)噪聲協(xié)方差陣的實(shí)時(shí)估計(jì)?;跇O大驗(yàn)后估計(jì)的自適應(yīng)

5、卡爾曼濾波動(dòng)態(tài)噪聲向量Wk、觀測(cè)噪聲向量Vk是互相獨(dú)立的正態(tài)白噪聲向量,滿足EWk=q,EVk=r,若噪聲的統(tǒng)計(jì)特性已知,可由極大驗(yàn)后估計(jì)原理得到自適應(yīng)卡爾曼濾波的遞推方程為:1)狀態(tài)向量一步預(yù)測(cè)值為 Xk,k-1=k,k-1 Xk-1,k-1+ qk-12)狀態(tài)向量一步預(yù)測(cè)值方差矩陣為Pk,k-1= k,k-1 Pk-1,k-1k,k-1T+Qk-1 3)狀態(tài)向量估計(jì)值為Xk,k= Xk,k-1+JkLk- HkXk,k-14)狀態(tài)向量估計(jì)值方差矩陣為Pk,k= I- JkHkPk,k-1其中,Jk為濾波增益矩陣,具體形式如下Jk= Pk,k-1HkTHkPk,k-1HkT+ Rk-1Rk為觀測(cè)噪聲方差矩陣。若噪聲均值向量q,r和協(xié)方差陣Qk,Rk未知時(shí),可以利用濾波估值Xj,j和預(yù)報(bào)值Xj,j-1近似代替計(jì)算較復(fù)雜的平滑估值Xk,j和Xk,j-1。由于地鐵站口基坑的開(kāi)挖施工,對(duì)

溫馨提示

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

評(píng)論

0/150

提交評(píng)論