出的递推最优估计理论,采用状态空间描述法,在算法采用递推形式,卡尔曼滤波能处理多维和非平稳的随机过程。
卡尔曼滤波的matlab实现如下所示:
%卡尔曼滤波器的应用,运动轨迹估计 clc; clear;
T=4;%雷达扫描周期 num=100;%滤波次数 %产生真实轨迹 N=800/T;
x=zeros(N,1);y=zeros(N,1); vx=zeros(N,1);vy=zeros(N,1); x(1)=-2000; y(1)=500; vx=10;vy=0; ax=0;ay=0; var=100; for i=1:N-1
x(i+1)=x(i)+vx*T+0.5*ax*T^2; y(i+1)=y(i)+vy*T+0.5*ay*T^2; end
nx=zeros(N,1);ny=zeros(N,1); nx=100*randn(N,1); ny=100*randn(N,1); zx=x+nx;zy=y+ny; %滤波100次 for m=1:num z=2:1; xks(1)=zx(1); yks(1)=zy(1); xks(2)=zx(2); yks(2)=zy(2); o=4:4;g=4:2;h=2:4; q=2:2;xk=4:1;perr=4:4;
o=[1,T,0,0;0,1,0,0;0,0,1,T;0,0,0,1]; h=[1 0 0 0;0 0 1 0]; g=[T/2,0;T/2,0;0,T/2;0,T/2];
q=[10000 0;0 10000]; perr=[var^2 var^2/T 0 0 var*var/T 2*var^2/(T^2) 0 0 0 0 var^2 var^2/T
0 0 var^2/T 2*var^2/(T^2)]; vx=(zx(2)-zx(1))/2; vy=(zy(2)-zy(1))/2; xk=[zx(1);vx;zy(1);vy]; %Kalman 滤波开始 for r=3:N; z=[zx(r);zy(r)]; xk1=o*xk; perr1=o*perr*o';
k=perr1*h'*inv(h*perr1*h'+q); xk=xk1+k*(z-h*xk1); perr=(eye(4)-k*h)*perr1; xks(r)=xk(1,1); yks(r)=xk(3,1); vkxs(r)=xk(2,1); vkys(r)=xk(4,1); xk1s(r)=xk1(1,1); ykls(r)=xk1(3,1); perr11(r)=perr(1,1); perr12(r)=perr(1,2); perr22(r)=perr(2,2); rex(m,r)=xks(r); rey(m,r)=yks(r);
end %结束一次滤波 end ex=0;ey=0; eqx=0;eqy=0; ey1=0;
ex1=N:1;ey1=N:1;
%计算滤波的均值,计算滤波误差的均值
卡尔曼滤波实现磁测定姿... 7页 免费喜欢此文档的还喜欢 卡尔曼滤波简介及其算法... 16页 1下载券 matlab对卡尔曼滤波的仿... 8页 免费 扩展卡尔曼滤波...
卡尔曼滤波简介及其算法实现代码(C++/C/MATLAB)卡尔曼滤波器简介 近来发现有些问题很多人都很感兴趣。所以在这里希望能尽自己能力跟大家 讨论一些力所能及的算法...
卡尔曼滤波简介说明及其算法 MATLAB 实现代码卡尔曼滤波算法实现代码(C,C++分别实现) 卡尔曼滤波器简介 近来发现有些问题很多人都很感兴趣。所以在这里希望能尽自己...
卡尔曼滤波简介及其算法... 16页 1下载券 利用Matlab和VisualC_实... 3页 1下载券 卡尔曼滤波实现磁测定姿... 7页 免费喜欢此文档的还喜欢...
维纳自适应滤波器设计及Matlab实现_电子/电路_工程科技_专业资料。维纳自适应滤波器设计及 Matlab 实现 摘 要 本文从随机噪声的特性出发,分析了传统滤波和自适应...
(0, 1200, N); % 滤波器阶数 M = 50; % 信号 s = 2 * sin(pi *... kalman滤波matlab实现 8页 免费 维纳、卡尔曼滤波简介及... 暂无评价 11页 ...
卡尔曼滤波器及matlab代码_信息与通信_工程科技_专业资料。卡尔曼滤波器...一种不需初始化的卡尔曼滤波器仿真这种滤波器只是实现了无需对部分变量进行初始...
卡尔曼滤波的MATLAB实现_工学_高等教育_教育专区。卡尔曼滤波的 MATLAB 实现一...卡尔曼滤波简介 卡尔曼滤波是解决以均方误差最小为准则的最佳线性滤波问题, 它...
维纳自适应滤波器设计及 Matlab 实现 摘 要 本文从随机噪声的特性出发,分析了传统滤波和自适应滤波基本工作原理和 性能,以及滤波技术的现状和发展前景。然后系统...
维纳滤波器 matlab实现_信息与通信_工程科技_专业资料。维纳滤波器 matlab实现实验报告册 数字图形图像处理维纳滤波器 matlab 实现 学专班学 院: 业: 级: 号: ...
热门文档