基于matlab的卡尔曼滤波算法仿真

《基于matlab的卡尔曼滤波算法仿真》由会员上传分享，免费在线阅读，更多相关内容在学术论文-天天文库。

1、基于Matlab的卡尔曼滤波算法仿真1.卡尔曼滤波器原理卡尔曼滤波是解决以均方误差最小为准则的最徒线性滤波问题，它根据前一个估计值和最近一个观察数据来估计信号的当前值。它是用状态方程和递推方法进行估计的,而它的解是以估计值(常常是状态变量的佔计值)的形式给出其信号模型是从状态方程和量测方程得到的。卡尔曼滤波中信号和噪声是用状态方程和测量方程来表示的。因此设计卡尔曼滤波器要求己知状态方程和测景方程。它不需要知道全部过去的数据，采用递推的方法计算，它既可以用于平稳和不平稳的随机过程，同时也可以应用解决非时变和

2、时变系统，冈而它比维纳过滤有更广泛的应用。卡尔曼几个重要公式：sD(n

3、n)=as口(n-l

4、n-l)+Gn[x(n)-acs口(n-l

5、n-l)](1)P(n)=a2^(n-1)+Q(2)Gn=(3)蜘)==(l-cGn)P⑻(4)这组方程的递推计算过程如图1所示。图1.卡尔曼滤波器递推运算流程图卡尔曼滤波过程实际上是获取维纳解的递推运算过程，这一过程从某个初始状态启动，经过迭代运算，最终到达稳定状态，即维纳滤波状态。递推计算按图1所示进行。假设已经有了初始值sEl(O

6、O)和$(0),这样便可由式(2

7、)计算P(l),由式(3)计算Gi，由式(4)计算$(1),由式(1)计算sEl(l

8、l)。$(1)和§(1

9、1)便成为下一轮迭代运算的已知数据。在递推运算过程中，随着迭代次数n的增加，g(n)将逐渐下降，知道最终趋近于某个稳定值^)。这时(n)(n-1)=^o为求得这个稳定值，将式(3)和式(2)代入式(4),得到^o2+解此方程即可求出2.基于Matlab的卡尔曼滤波器的仿真Matlab代码如下：clearN=200;w(1)=0;x(l)=5;a.=l;c=l；%过程噪声Ql=randn(l,N)*

10、1;%测量噪声Q2=randn(lzN)；%状态矩阵fork=2:N；x(k)=a*x(k-1)+Q1(k-1);endfork=l：N；Y(k)=c*x(k)+Q2(k)；endp(l)=10；s(1)=1;fort=2:N；Rww=cov(Q1(1:t));Rw=cov(Q2(1:t));pi(t)=a.x2*p(t-1)+Rww；%kalman塘益b(t)=c*pl(t)/(c.A2*pl(t)+Rw)；s(t)=a*s(t-l)+b(t)*(Y(t)-a*c*s(t-l));p(t)=pl(t)-

11、c*b(t)*pl(t);endFontSize=14；LineWidth=3;figure()；%両出温度计的测量值plot(Y,1k+*)；holdon；%

12、Wi出最优估计值plot(s,丨b-丨，丨LineWidth*,LineWidth)holdon；%画出真实值plot(x,丨g-',丨LineWidth丨，LineWidth)；legend('观测值*,1后验估计*,*真实值1);xl=xlabel(1')；yl=ylabel(1')；set(xl,1fontsizef,FontSize)；s

13、et(yl,1fontsize1,FontSize)；holdoff;set(gca,1FontSize1,FontSize)；figure()；valid_iter=[2:N]；%副出最优估计值的方差plot(valid_iterzp([valid_iter]),1LineWidth1,LineWidth)；legend('后验估计的误差估计')；xl=xlabel(1*);yl=ylabel(11)；set(xl,1fontsize',FontSize)；set(yl,'fontsize',FontS

14、ize);set(gca,丨FontSize丨，FontSize)；Matlab仿真结果如下:卡尔曼滤波的结果:估计的误差的方差：卡尔曼滤波的实质是由测量值重构系统的状态向量。它以“预测一实测一修正”的顺序递推，根据系统的测量值来消除随机干扰，再现系统的状态，或根据系统的测量值从被噪声污染的系统屮恢复系统的木来面口。从仿真结果可以看出，卡尔曼滤波器能够有效地在一定的噪声干扰下比较准确地反映真实值。3.课程实验总结通过现代数字信号处理课程的相关学习，我了解到了各种各样的数字信号处理方法，例如维纳滤波、卞•尔

15、曼滤波和自适应滤波等，并且每一种滤波器乂有不同的算法进行实现,但对于这些数字信号处理方法具体怎么实现以及各种方法适用于进行什么样数字信号处理场合没冇进行具体的实践工作。因此，通过课程实验可以加深我对于课堂学到的相关数字信号处理方法原理的理解以及加强Q己的动手能力。例如，我通过Matlab仿真软件对卡尔曼滤波器的仿真，使我对卡尔曼滤波器的原理冇了新的认识。