文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 工程科技 > 信息与通信 > kalman filter matlab代码
侵权投诉

kalman filter matlab代码

kalman filter matlab代码

%kalman filter¿¨¶ûÂüÂ˲¨

close all

clear

clc

A = [1,1;

0,1]; %״̬·½³Ì

B = [1/2,1]'; %ÊäÈë·½³Ì

C = [1,0];

x1(1)= 100; %³õʼ»¯

x2(1)= -1;

xz = [x1(1),x2(1)]';

x=xz;

z=C*x;

P = [10,0;0,1]; %Ð-·½²î¾ØÕó

Q=[0,0;0,0]; %¹ý³ÌÔëÉù¾ØÕó

R = 1; %¹Û²âÔëÉù¾ØÕó

g=9.8;

u=-g;

I=eye(2);

w = randn(1,1000,1); %ÔëÉùÐòÁÐ

%¹Û²âֵģÄâ

for k=2:1000

xz(:,k)=A*xz(:,k-1)+B*u;

zz(:,k)=C*xz(:,k)+w(k);

end

for k=2:1000

xk=A*x+B*u; %KF ·½³Ì1

xg1(k)=xk(1);

xg2(k)=xk(2);

z(k)=C*xk+w(k);

P=A*P*A'+Q; %KF ·½³Ì2 Kk=P*C'/(C*P*C'+R); %KF ·½³Ì3

x=xk+Kk*(zz(k)-C*xk); %KF ·½³Ì4 x1(k)=x(1);

x2(k)=x(2);

e1(k)=xz(1,k)-xg1(k);

e2(k)=xz(2,k)-xg2(k);

P=(I-Kk*C)*P; %KF ·½³Ì5 Ex1(k)=P(1,1);

Ex2(k)=P(2,2);

end

k=1:1000;

figure

plot(w)

title('°×ÔëÉùÇ¿¶ÈÇúÏß')

figure

subplot(2,1,1)

plot(k,e1)

title('x1(k)µÄ¹À¼ÆÖµºÍÕæÊµÖµÎó²îÇúÏß')

subplot(2,1,2)

plot(k,e2)

title('x2(k)µÄ¹À¼ÆÖµºÍÕæÊµÖµÎó²îÇúÏß')

第1页

你可能喜欢

  • 算法matlab代码
  • matlab车牌识别代码
  • matlab程序代码
  • 图像拼接算法
  • 代码大全
  • 数学建模答案
  • 图像二值化
  • 模糊图像复原

热门文档

相关文档

  • Kalman滤波和MATLAB实现

    tiankong Kalman 滤波和 MATLAB 实现卡尔曼滤波器(Kalman Filter)是一个最优化...(k)~ 重复以上步骤 Matlab 实现代码 ***...

  • Kalman Filter

    The Kalman Filter 8页 免费 Extended Kalman Filter 27页 免费 Kalman Filter 的C实现 1页 免费 Matlab+Kalman+Filter 6页 2财富值 A Kalman Filter Primer ...

  • matlab下面的kalman滤波程序(1)

    matlab下面的kalman滤波程序(1)_专业资料。基于matlab kalman滤波...filter(y, A, C, Q, R, init_x, init_V, varargin) % Kalman filter....

  • federated_kalman_filter

    暂无评价 5页 免费 Kalman Filter 的C实现 1页 免费 Matlab+Kalman+Filter 6页 2财富值 A Kalman Filter Primer 186页 1财富值...

  • 卡尔曼滤波matlab 代码

    卡尔曼滤波matlab 代码_信息与通信_工程科技_专业资料。卡尔曼滤波matlab 代码kalman 滤波 matlab 代码 %kalman filter 卡尔曼滤波 clear clc A = [1,1;0,1]...

  • 卡尔曼滤波器KalmanFilter

    卡尔曼滤波器(代码) 21页 免费 卡尔曼滤波器第四章 24页 免费 卡尔曼滤波... 32页 免费 kalman_filter 8页 免费 matlab对卡尔曼滤波的仿真... 8页 免费...

  • 基于MATLAB_GUI的Kalman滤波程序

    基于MATLAB_GUI的Kalman滤波程序_IT/计算机_专业...卡尔曼滤波器(Kalman Filter)是一个最优化自回归...同的图形对象来编写出能够实现该功能的函数代码, ...

  • matlab下面的kalman滤波程序

    matlab 下面的 kalman 滤波程序 clear N=200; w(1)=0; w=randn(1,N) x...[x, V, VV, loglik] = kalman_filter(y, A, C, Q, R, init_x, ...

  • 无迹信息kalman滤波matlab代码

    无迹信息kalman滤波matlab代码_信息与通信_工程科技_专业资料。无迹信息kalman滤波matlab代码%无迹信息kelman滤波matlab代码 %infilter %???¨ close all clear ...

  • 卡尔曼滤波Kalman filter

    卡尔曼滤波器 – Kalman Filter 1. 什么是卡尔曼滤波器 (What is the Kalman...已通过测试 --- 还有下面一个 Matlab 源程序,显示效果更好。 clear clc; N...

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