发 帖  
[资料] matlab卡尔曼滤波仿真程序(跟踪匀速运动的目标)
2012-3-19 14:47:03  19962 matlab
收藏 6 收藏 推荐 0 推荐
分享
本帖最后由 ningkui 于 2012-3-19 14:47 编辑

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

% 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');
游客,如果您要查看本帖隐藏内容请回复
显示全部楼层
最近下载过的用户(8)
· 2012-3-22 12:03:36
挺好
· 2012-3-22 12:38:38
dddddddddddd
· 2012-3-22 13:40:10
DDDDDDDDDDD顶!!!
· 2012-3-23 16:57:47
有没有对运动对象本身的仿真啊
· 2012-3-23 21:40:34
好东西,感谢分享
· 2012-3-29 07:49:26
haikeyizheyangwan
· 2012-4-14 21:28:51
绝对正点的东东,感谢楼主!
· 2012-7-12 20:50:12
ddddddd
· 2012-11-2 16:36:07
不错,可以结合理论理解
· 2012-11-12 08:30:03
· 2012-11-26 10:24:00
· 2012-11-26 14:13:19
不错!!
· 2012-11-28 14:06:20
学习一下,多谢楼主
· 2013-4-17 12:25:10
犀利 ,收下了。哈哈啊哈
· 2014-1-4 14:39:45
很好的说哦。。。。
· 2014-1-15 14:02:45
111111111111111111111111111111111
· 2014-1-16 15:47:58
ddddddddddddddddddddddddddd
· 2014-1-18 21:26:58
好好1111111111111111111111111111
· 2014-1-18 23:00:16
感谢楼主分享感谢楼主分享感谢楼主分享感谢楼主分享

评论

高级模式
您需要登录后才可以回帖 登录 | 注册

发资料
关闭

站长推荐 上一条 /9 下一条

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

推荐专区

技术干货集中营

专家问答

用户帮助┃咨询与建议┃版主议事

工程师杂谈

项目|工程师创意

招聘|求职}工程师职场

论坛电子赛事

社区活动专版

发烧友活动

-

嵌入式论坛

ARM技术论坛

Linux论坛

单片机/MCU论坛

MSP430技术论坛

FPGA|CPLD|ASIC论坛

STM32/STM8技术论坛

NXP MCU 技术论坛

DSP论坛

嵌入式系统论坛

-

电源技术论坛

电源技术论坛

无线充电技术

-

硬件设计论坛

电路设计论坛

电子元器件论坛

传感技术

总线技术|接口技术

-

测试测量论坛

LabVIEW论坛

Matlab论坛

测试测量技术专区

-

EDA设计论坛

multisim论坛

PCB设计论坛

PADS技术论坛

Protel|AD|DXP论坛

Allegro论坛

proteus论坛|仿真论坛

Orcad论坛

-

综合技术与应用

电机控制

工程资源中心

汽车电子技术论坛

医疗电子论坛

-

开源硬件

-

无线通信论坛

物联网技术

天线|RF射频|微波|雷达技术

-

IC设计论坛

芯片测试与失效分析

Analog/RF IC设计

设计与制造封装测试

-

厂商专区

TI论坛

TI Deyisupport社区

-

检测技术与质量

电磁兼容(EMC)设计与整改

安规知识论坛

检测与认证

-

消费电子论坛

手机技术论坛

平板电脑/mid论坛

音视/视频/机顶盒论坛

-

电子论坛综合区

聚丰众筹官方社区

新人报道区

聚丰供应链

-

论坛服务区

-

高校联盟

深圳大学电子协会

西藏民族学院电子设计协会

西安电子科技大学西电实验室

桂林电子科技大学机电工程协会

鉴鹰电子科技协会

广东海洋大学科技创新协会

福建农林大学电子科技创新协会

湖北理工学院电子技术协会

深圳职业技术学院电子精英训练营

浙江科技学院Zuster

湘潭大学电子科技协会

青岛理工大学琴岛学院天宏开发团队

河南理工大学大学生电器开发部

广西科技大学电气信息创新协会

浙江机电职业技术学院电子制作协会

郑州大学西亚斯国际学院爱电工作室

新乡学院电子创新工作室

洛阳理工学院SmartTeam

苏州工业职业技术学院创新工作室

浙江工业大学GC315团队

杭电-微芯大学生科技创新孵化器

西安工业大学电信科协

商洛学院科技创新协会

大连民族学院创新工作室

南京信息工程大学帆木工作室

-

供求信息发布

方案交易

供需广告

芯片求购|供应发布区