资源简介
该代码由matlab编写,对目标实行追踪,该代码由注释,实现了对下落小球的追踪
代码片段和文件信息
%Kalman滤波
clear
N=800;
w(1)=0;
%系统预测的随机白噪声
w=randn(1N)
x(1)=0;
a=1;
for k=2:N;
%系统的预测值
x(k)=a*x(k-1)+w(k-1);
end
%测量值的随机白噪声
V=randn(1N);
q1=std(V);
Rvv=q1.^2;
q2=std(x);
Rxx=q2.^2;
q3=std(w);
Rww=q3.^2;
c=0.2;
%测量值
Y=c*x+V;
p(1)=0;
s(1)=0;
for t=2:N;
%前一时刻X的协方差系数
p1(t)=a.^2*p(t-1)+Rww;
%Kalman增益
b(t)=c*p1(t)/(c.^2*p1(t)+Rvv);
%经过滤波后的信号
s(t)=a*s(t-1)+b(t)*(Y(t)-a*c*s(t-1));
%t状态下x(t|t)的协方差系数
p(t)=p1(t)-c*b(t)*p1(t);
end
subplot(131)
plot(x)
title(‘系统的预测值‘)
subplot(132)
plot(Y)
title(‘测量值‘)
subplot(133)
plot(s)
title(‘滤波后的信号‘)
属性 大小 日期 时间 名称
----------- --------- ---------- ----- ----
文件 659 2012-02-14 22:29 3.19 基于Kalman滤波的目标跟踪\ex1.m
文件 1468 2012-02-14 22:42 3.19 基于Kalman滤波的目标跟踪\extractball.m
文件 1587 2012-02-14 22:31 3.19 基于Kalman滤波的目标跟踪\main.m
文件 24064 2011-09-26 22:28 3.19 基于Kalman滤波的目标跟踪\程序运行说明.doc
文件 3857 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\1.jpg
文件 4094 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\10.jpg
文件 4101 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\11.jpg
文件 4089 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\12.jpg
文件 4072 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\13.jpg
文件 3988 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\14.jpg
文件 3967 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\15.jpg
文件 3996 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\16.jpg
文件 4019 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\17.jpg
文件 4023 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\18.jpg
文件 4104 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\19.jpg
文件 3879 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\2.jpg
文件 4134 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\20.jpg
文件 4146 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\21.jpg
文件 4119 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\22.jpg
文件 4062 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\23.jpg
文件 4032 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\24.jpg
文件 4067 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\25.jpg
文件 4076 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\26.jpg
文件 4008 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\27.jpg
文件 3972 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\28.jpg
文件 4099 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\29.jpg
文件 3863 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\3.jpg
文件 4087 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\30.jpg
文件 4082 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\31.jpg
文件 4020 2011-05-19 17:10 3.19 基于Kalman滤波的目标跟踪\DATA\32.jpg
............此处省略40个文件信息
评论
共有 条评论