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)µÄ¹À¼ÆÖµºÍÕæÊµÖµÎó²îÇúÏß')
tiankong Kalman 滤波和 MATLAB 实现卡尔曼滤波器(Kalman Filter)是一个最优化...(k)~ 重复以上步骤 Matlab 实现代码 ***...
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滤波...filter(y, A, C, Q, R, init_x, init_V, varargin) % Kalman filter....
暂无评价 5页 免费 Kalman Filter 的C实现 1页 免费 Matlab+Kalman+Filter 6页 2财富值 A Kalman Filter Primer 186页 1财富值...
卡尔曼滤波matlab 代码_信息与通信_工程科技_专业资料。卡尔曼滤波matlab 代码kalman 滤波 matlab 代码 %kalman filter 卡尔曼滤波 clear clc A = [1,1;0,1]...
卡尔曼滤波器(代码) 21页 免费 卡尔曼滤波器第四章 24页 免费 卡尔曼滤波... 32页 免费 kalman_filter 8页 免费 matlab对卡尔曼滤波的仿真... 8页 免费...
基于MATLAB_GUI的Kalman滤波程序_IT/计算机_专业...卡尔曼滤波器(Kalman Filter)是一个最优化自回归...同的图形对象来编写出能够实现该功能的函数代码, ...
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代码%无迹信息kelman滤波matlab代码 %infilter %???¨ close all clear ...
卡尔曼滤波器 – Kalman Filter 1. 什么是卡尔曼滤波器 (What is the Kalman...已通过测试 --- 还有下面一个 Matlab 源程序,显示效果更好。 clear clc; N...
热门文档