卡曼濾波和最小二乘法濾波比較_第1頁
卡曼濾波和最小二乘法濾波比較_第2頁
卡曼濾波和最小二乘法濾波比較_第3頁
全文預(yù)覽已結(jié)束

下載本文檔

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

文檔簡介

卡曼濾波和最小二乘法濾波比較最小二乘法matlab程序x=0:0.1:2*pi;y=sin(x);plot(x,y,'r-','linewidth',2);holdonk=0.1;y1=y+k*(0.5-rand(1,63));plot(x,y1,'k.');p=polyfit(x,y1,6);f=polyval(p,x);plot(x,f,'b*-');legend('O—總吻f^Ef','瓦令。了f吻Ef');title('xiBj^^3E^^Aa°iQuiB');xlabel('x');ylabel('y');運行結(jié)果卡曼濾波matlab程序x=0:0.1:2*pi;y=sin(x);k=0.1;y1=y+k*(0.5-rand(1,63));plot(y1,'r.');holdonplot(y,'g-');y(1)=0;p(1)=2八2;i=0;A=1;H=1;Q=4八2;R=4A2;fori=1:63xpred=A*y(i);%k—1,p(k|k—1)=3入2;ppred=A*p(i)*A'+Q; %0總^了卩(3亜《2[￡—Q=4入2;%K=p(k|k-1)H'/(p(k|k-1)+R);REQ1U2i^0Oo￡-R=4A2;%K=￡“5入2)/(5入2+4入2);K(i)=ppred*inv(H)/(H*ppred*H'+R);%x(k|k)=x(k|k-1)+K(k)(Z-H*x(k|k-1));xnew=xpred+K(i)*(y1(i)-H*xpred);%p(k|k)=(1-K*H)*p(k|k-1);pnew=(1-K(i)*H)*ppred;y(i+1)=xnew;p(i+1)=pnew;endplot(y,'k*-');title('min');legend('O—總吻f吻了垃','Aa°IQuiB');xlabel('x');ylabel('y');運行結(jié)果min同樣改變參數(shù)k=0.8得到的圖像比較：xx最小二乘法Kalman濾波min同樣改變參數(shù)k=0.8得到的圖像比較：xx最小

溫馨提示

  • 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)方式做保護處理，對用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯，并不能對任何下載內(nèi)容負責(zé)。
  • 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容，請與我們聯(lián)系，我們立即糾正。
  • 7. 本站不保證下載資源的準確性、安全性和完整性, 同時也不承擔(dān)用戶因使用這些下載資源對自己和他人造成任何形式的傷害或損失。

評論

0/150

提交評論