文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > IT/计算机 > 计算机软件及应用 > notes_on_kalman_filter
侵权投诉

notes_on_kalman_filter

notes_on_kalman_filter

m2d=c2d(ss([Akfnothing;nothingAkf],[00;01;00;10],...

[1000;0010],[00;00]),sampletime);

%Couldusethe(incorrect)discretetimemodeltocomparetotheactualwalk

%Xx=[0000]’;forii=2:length(u);Xx(:,ii)=m2d.a*Xx(:,ii-1)+m2d.b*u(ii,:)’;end%NowsetuptheKalmanfilter

A=m2d.a;%Aisa(probablyincorrect)modelofthesystem

H=[1000;0010];%wewillbeabletomakeadirectmeasureof

%onlythex/ypositions

Xmeas=[0000]’;%ourfirstprediction,whereitstartsPmeas=eye(4);%firstguessatthecovariancematrix

Q=.1*[ones(2,2)zeros(2,2);zeros(2,2)ones(2,2)];%ourestimateof

%modelnoisevariance

R=.1;%ourestimateofthesensornoisevarianceXallpred=[];%placetoputstatesafterpredictionsXallmeas=[];%placetoputstatesaftermeasurementXnpred=[0;0];

tk=tt;%tk=0:sampletime:20;forjj=1:length(tk)%Prediction

Xnewpred=A*Xmeas;

Pnewpred=A*Pmeas*A’+Q;

Xpred=Xnewpred;%savetooldvaluesPpred=Pnewpred;

Xallpred=[XallpredXnewpred];%historyofpredictionstate%Measurement

znew=x_w(:,jj)+.01*randn;

K=Pnewpred*H’/(H*Pnewpred*H’+R);

Xnewmeas=Xnewpred+K*(znew-H*Xnewpred);Pnewmeas=(eye(4)-K*H)*Pnewpred;

Xmeas=Xnewmeas;%savetooldvaluesPmeas=Pnewmeas;

Xallmeas=[XallmeasXnewmeas];%historyofmeasurementstateend

%MakeapredictionateachtimepointonwhereWallyisgoing%Thesedependontheestimatestate,andtheincorrectmodelPredict1=(A-eye(4))*Xallmeas;%1*sampletimeprediction

Predict10=(A^10-eye(4))*Xallmeas;%10*sampletimepredictiondeltax=[x_w(1,:);x_w(1,:)+Predict10(1,:)];deltay=[x_w(2,:);x_w(2,:)+Predict10(3,:)];

figure(1)

plot(x_w(1,:),x_w(2,:),Xallmeas(1,:),Xallmeas(3,:));shgtitle(’ThetruepathandtheKalmanestimate’)figure(2)

plot(tt,x_w,tk,Xallmeas’,tk,Xallpred)title(’Themodelstatesovertime’)figure(3)

上一页第4页

你可能喜欢

热门文档

相关文档

  • federated_kalman_filter

    The federated unscented Kalman filter (FUKF) is composed of the federated ...The particle filter relies on importance sampling, and however, it is ...

  • Kalman Filter介绍

    Kalman Filter介绍_数学_自然科学_专业资料。卡尔曼滤波(kalman filter)最简单易懂的解释,对初学者有很大的帮助KALMAN FILTER INTRODUCTION 1 简介(Brief Introduction...

  • kalman filter

    随着后续不断的研究和拓展,卡尔曼滤波有如下内容:离散卡尔曼滤波、连 续卡尔曼滤波、线性与非线性估计之分,自适应卡尔曼滤波(Adaptive Kalman Filter)、扩展卡尔曼...

  • Kalman Filter

    Kalman Filter_交通运输_工程科技_专业资料。卡尔曼滤波器介绍卡尔曼滤波 The Kalman Filtering article 2005.11 Contents 背景简介 一个实际问题 算法描述 实验应用...

  • ...elements on-line assaying using Kalman Filter

    Prediction of XRF analyzers error for elements on-line assaying using Kalman Filter_专业资料。Ientnlorao nn cecn ehooy222556 ntraiaJunlfo MiigSineadTcnlg ...

  • KalmanFilter.v2

    (t -1.5, p_, 'b'); hold on; h2 = stem(t -1.25, p, 'g')...无迹卡尔曼滤波器(Unscented Kalman Filter 或 UKF)很好地克服了 EKF 的缺陷。...

  • DSGE模型讨论之九——卡尔曼滤波 The Kalman Filter2_...

    The speci?c advanced matrix algebra techniques used in this notes will be ...Then the second section will be derivation of the Kalman ?lter based on ...

  • Ensemble Kalman filter

    Ensemble Kalman filter_计算机软件及应用_IT/计算机_专业资料。数据同化的一种...[11] on each ensemble [9] does not need to be known explicitly. This ...

  • Extended Kalman Filter

    Extended Kalman Filter_工学_高等教育_教育专区。卡尔曼滤波 Kalman Filte...1 Kk = T C k H k Gk Which to use depends on the dimensions of ...

  • 卡尔曼滤波Kalman filter

    卡尔曼滤波器 – Kalman Filter 1. 什么是卡尔曼滤波器 (What is the Kalman Filter ) 在学习卡尔曼滤波器之前,首先看看为什么叫“卡尔曼”。跟其他著名的理论...

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email