卡爾曼濾波matlab實(shí)例_第1頁(yè)
卡爾曼濾波matlab實(shí)例_第2頁(yè)
卡爾曼濾波matlab實(shí)例_第3頁(yè)
卡爾曼濾波matlab實(shí)例_第4頁(yè)
卡爾曼濾波matlab實(shí)例_第5頁(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、% 程序說(shuō)明:Kalman濾波用于溫度測(cè)量的實(shí)例% 詳細(xì)原理介紹及中文注釋請(qǐng)參考:% 卡爾曼濾波原理及應(yīng)用-MATLAB仿真,電子工業(yè)出版社,黃小平著。%function main%N=120;CON=25;Xexpect=CON*ones(1,N);X=zeros(1,N); Xkf=zeros(1,N);Z=zeros(1,N);P=zeros(1,N); X(1)=25.1;P(1)=0.01;Z(1)=24.9;Xkf(1)=Z(1);Q=0.01;R=0.25;W=sqrt(Q)*randn(1,N);V=sqrt(R)*randn(1,N);F=1;G=1;H=1;I=eye(1)

2、; %for k=2:N X(k)=F*X(k-1)+G*W(k-1); Z(k)=H*X(k)+V(k); X_pre=F*Xkf(k-1); P_pre=F*P(k-1)*F'+Q; Kg=P_pre*inv(H*P_pre*H'+R); e=Z(k)-H*X_pre; Xkf(k)=X_pre+Kg*e; P(k)=(I-Kg*H)*P_pre;end%Err_Messure=zeros(1,N);Err_Kalman=zeros(1,N);for k=1:N Err_Messure(k)=abs(Z(k)-X(k); Err_Kalman(k)=abs(Xkf(k)-X

3、(k);endt=1:N;figure('Name','Kalman Filter Simulation','NumberTitle','off');plot(t,Xexpect,'-b',t,X,'-r',t,Z,'-k',t,Xkf,'-g');legend('expected','real','measure','kalman extimate'); xlabel('sample time');ylabel('temperature');title('Kalman Filter Simulation');figure('Name','Error Analysis','NumberTitle','off');plot(t,Err_Messure,'-b',t,Err_Kalman,'-k');legend('messure error&#

溫馨提示

  • 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)論