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

基于Matlab的卡尔曼滤波算法仿真基于Matlab的卡尔曼滤波算法仿真 ------------------------------------------------------------------------------------------------ 基于Matlab的卡尔曼滤波算法仿真 1.卡尔曼滤波器原理卡尔曼滤波是解决以均方误差最小为准则的最佳线性滤波问题，它根据前一个估计值和最近一个观察数据来估计信号的当前值。它是用状态方程和递推方法进行估计的，而它的解是以估计值(常常是状态变量的估计值)的形式给出其信号模型是从状态...

基于Matlab的卡尔曼滤波算法仿真 ------------------------------------------------------------------------------------------------ 基于Matlab的卡尔曼滤波算法仿真 1.卡尔曼滤波器原理卡尔曼滤波是解决以均方误差最小为准则的最佳线性滤波问题，它根据前一个估计值和最近一个观察数据来估计信号的当前值。它是用状态方程和递推方法进行估计的，而它的解是以估计值(常常是状态变量的估计值)的形式给出其信号模型是从状态方程和量测方程得到的。卡尔曼滤波中信号和噪声是用状态方程和测量方程来表示的。因此设计卡尔曼滤波器要求已知状态方程和测量方程。它不需要知道全部过去的数据，采用递推的方法计算，它既可以用于平稳和不平稳的随机过程，同时也可以应用解决非时变和时变系统，因而它比维纳过滤有更广泛的应用。卡尔曼几个重要公式: s??(n|n)=as??(n-1|n-1)+Gn[x(n)–acs??(n-1|n-1)](1)P(n)=a2ξ(n-1)+Q(2)Gn=(3)ξ(n)==(1–cGn)P(n)(4)这组方程的递推计算过程如图1 所示。图1.卡尔曼滤波器递推运算流程图卡尔曼滤波过程实际上是获取维纳解的递推运算过程，这一过程从某个初始状态启动，经过迭代运算，最终到达稳定状态，即维纳滤波状态。递推—————————————————————————————————————— ------------------------------------------------------------------------------------------------ 计算按图1所示进行。假设已经有了初始值s??(0|0)和ξ(0)，这样便可由式(2)计算P(1)，由式(3)计算G1，由式(4)计算ξ(1)，由式(1)计算s??(1|1)。ξ(1)和s??(1|1)便成为下一轮迭代运算的已知数据。在递推运算过程中，随着迭代次数n的增加，ξ(n)将逐渐下降，知道最终趋近于某个稳定值ξ0。这时 ξ(n)=ξ(n-1)=ξ0 为求得这个稳定值，将式(3)和式(2)代入式(4)，得到 ξ02+ 解此方程即可求出ξ0。 2.基于Matlab的卡尔曼滤波器的仿真 Matlab代码如下: clearN=200;w(1)=0;x(1)=5;a=1;c=1; %过程噪声 Q1=randn(1,N)*1; %测量噪声 Q2=randn(1,N); %状态矩阵 fork=2:N;x(k)=a*x(k-1)+Q1(k-1);endfork=1:N;Y(k)=c*x(k)+Q2(k);endp(1)= 10;s(1)=1;fort=2:N;Rww=cov(Q1(1:t));Rvv=cov(Q2(1:t));p1(t)=a.^2*p(t-1) +Rww; %kalman增益 —————————————————————————————————————— ------------------------------------------------------------------------------------------------ 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); endFontSize=14;LineWidth=3;figure(); %画出温度计的测量值 plot(Y,'k+');holdon; %画出最优估计值 plot(s,'b-','LineWidth',LineWidth)holdon; %画出真实值 plot(x,'g-','LineWidth',LineWidth); legend('观测值','后验估计','真实值 '); xl=xlabel('');yl=ylabel('');set(xl,'fontsize',FontSize);set(yl,'fontsize',FontSize);holdoff;set(gca,'FontSize',FontSize);figure();valid_iter=[2:N]; %画出最优估计值的方差 plot(valid_iter,p([valid_iter]),'LineWidth',LineWidth);legend('后验估计的误差估计'); xl=xlabel('');yl=ylabel('');set(xl,'fontsize',—————————————————————————————————————— ------------------------------------------------------------------------------------------------ FontSize);set(yl,'fontsize',FontSize);set(gca,'FontSize 9;,FontSize); Matlab仿真结果如下: 卡尔曼滤波的结果: 估计的误差的方差: 卡尔曼滤波的实质是由测量值重构系统的状态向量。它以“预测—实测—修正”的顺序递推，根据系统的测量值来消除随机干扰，再现系统的状态，或根据系统的测量值从被噪声污染的系统中恢复系统的本来面目。从仿真结果可以看出，卡尔曼滤波器能够有效地在一定的噪声干扰下比较准确地反映真实值。 3.课程实验总结通过现代数字信号处理课程的相关学习，我了解到了各种各样的数字信号处理方法，例如维纳滤波、卡尔曼滤波和自适应滤波等，并且每一种滤波器又有不同的算法进行实现，但对于这些数字信号处理方法具体怎么实现以及各种方法适用于进行什么样数字信号处理场合没有进行具体的实践工作。因此，通过课程实验可以加深我对于课堂学到的相关数字信号处理方法原理的理解以及加强自己的动手能力。例如，我通过Matlab仿真软件对卡尔曼滤波器的仿真，使我对卡尔曼滤波器的原理有了新的认识。 ——————————————————————————————————————

                    本文档为【基于Matlab的卡尔曼滤波算法仿真】，请使用软件OFFICE或WPS软件打开。作品中的文字与图均可以修改和编辑，
                    图片更改请在作品中右键图片并更换，文字修改请直接点击文字进行修改，也可以新增和删除文档中的内容。 
 该文档来自用户分享，如有侵权行为请发邮件ishare@vip.sina.com联系网站客服，我们会及时删除。

                    [版权声明] 本站所有资料为用户分享产生，若发现您的权利被侵害，请联系客服邮件isharekefu@iask.cn，我们尽快处理。

                    本作品所展示的图片、画像、字体、音乐的版权可能需版权方额外授权，请谨慎使用。

                    网站提供的党政主题相关内容(国旗、国徽、党徽..)目的在于配合国家政策宣传，仅限个人学习分享使用，禁止用于任何广告和商用目的。
                

下载需要：免费已有0 人下载

立即下载

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

你可能还喜欢