卡尔曼滤波matlab实例_第1页
卡尔曼滤波matlab实例_第2页
卡尔曼滤波matlab实例_第3页
卡尔曼滤波matlab实例_第4页
卡尔曼滤波matlab实例_第5页
全文预览已结束

下载本文档

版权说明：本文档由用户提供并上传，收益归属内容提供方，若内容存在侵权，请进行举报或认领

文档简介

1、% 程序说明：Kalman滤波用于温度测量的实例% 详细原理介绍及中文注释请参考：% 卡尔曼滤波原理及应用-MATLAB仿真，电子工业出版社，黄小平著。%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. 本站所有资源如无特殊说明，都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等，如果需要附件，请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸，网页内容里面会有图纸预览，若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间，仅对用户上传内容的表现方式做保护处理，对用户上传分享的文档内容本身不做任何修改或编辑，并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容，请与我们联系，我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

最新文档

评论

0/150

提交评论