智能车制作

 找回密码
 注册

扫一扫,访问微社区

查看: 1653|回复: 3
打印 上一主题 下一主题

[分享] kalman滤波matlab仿真

[复制链接]

17

主题

375

帖子

0

精华

常驻嘉宾

Rank: 8Rank: 8

积分
3363

活跃会员奖章优秀会员奖章在线王奖章

威望
1269
贡献
520
兑换币
371
注册时间
2012-5-22
在线时间
787 小时
跳转到指定楼层
1#
发表于 2012-11-19 23:37:06 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
clear
N=200;
w(1)=0;
w=randn(1,N)
x(1)=0;
a=1;
for k=2:N;
x(k)=a*x(k-1)+w(k-1);
end

V=randn(1,N);
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;
p1(t)=a.^2*p(t-1)+Rww;
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));
p(t)=p1(t)-c*b(t)*p1(t);
end
t=1:N;
plot(t,s,'r',t,Y,'g',t,x,'b');

本帖子中包含更多资源

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

x

5

主题

55

帖子

0

精华

高级会员

Rank: 4

积分
845
威望
505
贡献
194
兑换币
113
注册时间
2011-12-11
在线时间
73 小时
2#
发表于 2012-11-20 11:48:30 | 只看该作者
mark
回复 支持 反对

使用道具 举报

7

主题

221

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
2302
威望
1147
贡献
697
兑换币
627
注册时间
2011-11-10
在线时间
229 小时
3#
发表于 2012-11-20 12:48:19 | 只看该作者
回复 支持 反对

使用道具 举报

3

主题

64

帖子

0

精华

高级会员

Rank: 4

积分
935
QQ
威望
563
贡献
204
兑换币
182
注册时间
2012-1-10
在线时间
84 小时
4#
发表于 2013-3-30 19:09:17 | 只看该作者
怎么出来的?什么意思啊?
回复 支持 反对

使用道具 举报

您需要登录后才可以回帖 登录 | 注册

本版积分规则

关于我们|联系我们|小黑屋|智能车制作 ( 黑ICP备2022002344号

GMT+8, 2024-12-27 15:30 , Processed in 0.073916 second(s), 32 queries , Gzip On.

Powered by Discuz! X3.2

© 2001-2013 Comsenz Inc.

快速回复 返回顶部 返回列表