matlab卡尔曼滤波仿真程序（跟踪匀速运动的目标）

monsterskyy · 发表于 2021-4-26 09:58

EDA365欢迎您登录！

您需要登录才可以下载或查看，没有帐号？注册

x

卡尔曼滤波仿真程序用于匀速运动的目标跟踪

% kalman filtering

load initial_track s; % y:initial data,s:data with noise
T=0.1;

% yp denotes the sample value of position
% yv denotes the sample value of velocity
% Y=[yp(n);yv(n)];
% error deviation caused by the random acceleration
% known data
Y=zeros(2,200);
Y0=[0;1];
Y(:,1)=Y0;
A=[1 T
0 1];
B=[1/2*(T)^2 T]';
H=[1 0];

C0=[0 0
0 1];
C=[C0 zeros(2,2*199)];
Q=(0.25)^2;
R=(0.25)^2;

% kalman algorithm ieration
for n=1:200
i=(n-1)*2+1;
K=C(:,i:i+1)*H'*inv(H*C(:,i:i+1)*H'+R);
Y(:,n)=Y(:,n)+K*(s(:,n)-H*Y(:,n));
Y(:,n+1)=A*Y(:,n);
C(:,i:i+1)=(eye(2,2)-K*H)*C(:,i:i+1);
C(:,i+2:i+3)=A*C(:,i:i+1)*A'+B*Q*B';
end

% the diagram of position after filtering
t=0:0.1:20;
figure(2);
yp=Y(1,：);
plot(t,yp,'r.-');
axis([0 20 0 20]);
xlabel('time');
ylabel('yp position');
title('the track after kalman filtering');
hold on;

% the diagram of velocity after filtering
figure(3);
yv=Y(2,：);
plot(t,yv,'k.-');
xlabel('time');
ylabel('yv velocity');
title('the velocity caused by random acceleration');

游客，如果您要查看本帖隐藏内容请回复

nevadaooo · 发表于 2021-4-26 11:19

有没有对运动对象本身的仿真啊，分享一下

帐号		自动登录	找回密码
密码			注册

matlab卡尔曼滤波仿真程序（跟踪匀速运动的目标）

EDA365欢迎您登录！

浏览过的版块

推荐内容 /1