資源簡介
對(duì)加計(jì)原始數(shù)據(jù)的卡爾曼濾波matlab程序,本人親測(cè)的。把代碼考進(jìn)去,直接運(yùn)行就能看到結(jié)果啦。
代碼片段和文件信息
clear
N=3000;
w(1)=0;
q?=?1e-3;
w=CreateGauss(0q1N);
x(1)=0;
a=1;
for?k=2:N;
x(k)=a*x(k-1)+w(k-1);
end
r?=?5.63;
%V=CreateGauss(0r1N);
%q1=std(V);
q1?=?2.3;
q2=std(x);
Rvv=q1.^2;
Rxx=q2.^2;
q3=std(w);
Rww=q3.^2;
c=1;
fid?=?fopen(‘x.txt‘‘r‘);
for?i?=?1:1
????y?=?fscanf(fid‘%f‘);
?%???y?=?y-33.6316;
????y?=?y‘;
end
p(1)=1e-1;
o(1)=1;
s(1)?=?0;
v(1)?=?0;
for?t=2:N;
p1(t)=a.^2*p(t-1)+Rww
評(píng)論
共有 條評(píng)論