24小时热门版块排行榜    

查看: 370  |  回复: 1
当前主题已经存档。

liugh01

金虫 (小有名气)

[交流] 【求助】精通kalman滤波的大侠请进.

我编写了关于kalman滤波的matlab程序,程序不长,可结果就是不对,请大侠帮忙看看程序有什么问题.多谢.
跟踪一个纯复数信号y(t)=exp(i*w*t);

clear all;
t=0:0.02/64:0.02*20;
s=2*(cos(2*pi*50*t)+sqrt(-1)*sin(2*pi*50*t));%被分析信号
y=s;
tx1(1)=1;tx2(1)=1;pk=[1 0;0 1];kk=[0.3 1]';%设初值
h=[0 1];

for k=2:1:100
px1(k)=tx1(k-1);
px2(k)=tx1(k-1)*tx2(k-1);
pkx=[px1(k) px2(k)]'; %求x(k|k-1)
txk=pkx+kk*(y(k)-h*pkx); %求x(k|k)
fk=[1 0;tx2(k-1) tx1(k-1)];
mk=fk*pk*(conj(fk))';
kk=mk*(conj(h))'*inv(h*mk*(conj(h))'+1);%求增益k
tx1(k)=txk(1);
tx2(k)=txk(2);
pk=mk-kk*h*mk;
end;

[ Last edited by 2007骑猪逛街 on 2009-1-28 at 00:51 ]
回复此楼

» 猜你喜欢

已阅   回复此楼   关注TA 给TA发消息 送TA红花 TA的回帖

sunyuanxin

禁虫 (著名写手)

本帖内容被屏蔽

2楼2009-03-10 11:28:32
已阅   回复此楼   关注TA 给TA发消息 送TA红花 TA的回帖
相关版块跳转 我要订阅楼主 liugh01 的主题更新
普通表情 高级回复 (可上传附件)
信息提示
请填处理意见