《卡尔曼滤波器及matlab代码.doc》由会员分享，可在线阅读，更多相关《卡尔曼滤波器及matlab代码.doc（18页珍藏版）》请在金锄头文库上搜索。
1、信息融合大作业维纳最速下降法滤波器，卡尔曼滤波器设计及Matlab仿真时间：2010-12-6专业：信息工程班级：09030702学号：2007302171 姓名：马志强1. 滤波问题浅谈估计器或滤波器这一术语通常用来称呼一个系统，设计这样的系统是为了从含有噪声的数据中提取人们感兴趣的，接近规定质量的信息。由于这样一个宽目标，估计理论应用于诸如通信、雷达、声纳、导航、地震学、生物医学工程、金融工程等众多不同的领域。例如，考虑一个数字通信系统，其基本形式由发射机、信道和接收机连接组成。发射机的作用是把数字源(例如计算机)产生的0、1符号序列组成的消息信号变换成为适合于信道上传送的波形。而由于符号
2、间干扰和噪声的存在，信道输出端收到的信号是含有噪声的或失真的发送信号。接收机的作用是，操作接收信号并把原消息信号的一个可靠估值传递给系统输出端的某个用户。随着通信系统复杂度的提高，对原消息信号的还原成为通信系统中最为重要的环节，而噪声是接收端需要排除的最主要的干扰，人们也设计出了针对各种不同条件应用的滤波器，其中最速下降算法是一种古老的最优化技术，而卡尔曼滤波器随着应用条件的精简成为了普适性的高效滤波器。2维纳最速下降算法滤波器2.1 最速下降算法的基本思想考虑一个代价函数J(w)，它是某个未知向量w的连续可微分函数。函数J(w)将w的元素映射为实数。这里，我们要寻找一个最优解w。使它满足如下
3、条件J(w0)J(w)(2.1)这也是无约束最优化的数学表示。特别适合于自适应滤波的一类无约束最优化算法基于局部迭代下降的算法：从某一初始猜想w(0)出发，产生一系列权向量w1,w2,，使得代价函数J(w)在算法的每一次迭代都是下降的，即Jwn+1J(w(n)其中w(n)是权向量的过去值，而wn+1是其更新值。我们希望算法最终收敛到最优值w0。迭代下降的一种简单形式是最速下降法，该方法是沿最速下降方向连续调整权向量。为方便起见，我们将梯度向量表示为g=Jw=J(w)w(2.2)因此，最速下降法可以表示为wn+1=wn-12g(n)(2.3)其中n代表进程，是正常数，称为步长参数，1/2因子的引
4、入是为了数学上处理方便。在从n到n+1的迭代中，权向量的调整量为wn=wn+1-wn=-12g(n)(2.4)为了证明最速下降算法满足式(2.1)，在wn处进行一阶泰勒展开，得到Jwn+1Jwn+gHnw(n)(2.5)此式对于较小时是成立的。在式(2.4)中设w为负值向量，因而梯度向量g也为负值向量，所以使用埃尔米特转置。将式(2.4)用到式(2.5)中，得到Jwn+1Jwn-12g(n)2此式表明当为正数时，Jwn+1J(w(n)。因此，随着n的增加，代价函数Jn减小，当n=时，代价函数趋于最小值J。2.2最速下降算法应用于维纳滤波器考虑一个横向滤波器，其抽头输入为un,un-1,u(n-
5、M+1)，对应的抽头权值为w0n,w1n,wM-1n。抽头输入是来自零均值、相关矩阵为R的广义平稳随机过程的抽样值。除了这些输入外，滤波器还要一个期望响应d(n)，以便为最优滤波提供一个参考。在时刻n抽头输入向量表示为u(n)，滤波器输出端期望响应的估计值为d(n|Un),其中Un是由抽头输un,un-1,u(n-M+1)所张成的空间。空过比较期望响应d(n)及其估计值，可以得到一个估计误差e(n)，即en=dn-dnUn=dn-wHnu(n)(2.6)这里wHnu(n)是抽头权向量w(n)与抽头输入向量u(n)的内积。w(n)可以进一步表示为wn=w0n,w1n,wM-1nT同样，抽头输入向
6、量u(n)可表示为un=un,un-1,un-M+1T如果抽头输入向量un和期望响应dn是联合平稳的，此时均方误差或者在时刻n的代价函数J(n)是抽头权向量的二次函数，于是可以得到Jn=d2-wHnp-pHwn+wHnRw(n)(2.7)其中，d2为目标函数dn的方差，p抽头输入向量un与期望响应dn的互相关向量，及R为抽头输入向量un的相关矩阵。从而梯度向量可以写为Jn=J(n)a0(n)+jJ(n)b0(n)J(n)a1(n)J(n)aM-1(n)+jJ(n)b1(n)J(n)bM-1(n)=-2p+2Rw(n)(2.8)其中在列向量中J(n)ak(n)和J(n)bk(n)分别是代价函数J
7、n对应第k个抽头权值wkn的实部ak(n)和虚部bk(n)的偏导数。对最速下降算法应用而言，假设式(2.8)中相关矩阵R和互相关向量p已知，则对于给定的抽头权向量wn+1为wn+1=wn+p-Rwn(2.9)它描述了为那滤波中最速下降法的数学表达式。3.卡尔曼滤波器3.1卡尔曼滤波器的基本思想卡尔曼滤波器是用状态空间概念描述其数学公式的，另外新颖的特点是，他的解递归运算，可以不加修改地应用于平稳和非平稳环境。尤其是，其状态的每一次更新估计都由前一次估计和新的输入数据计算得到，因此只需存储前一次估计。除了不需要存储过去的所有观测数据外，卡尔曼滤波计算比直接根据滤波过程中每一步所有过去数据进行估值
8、的方法都更加有效。z-1I+v1(n) x(n+1) xn y(n)F(n+1,n) C(n) v2(n)图3.1 线性动态离散时间系统的信号流图表示“状态”的概念是这种表示的基础。状态向量，简单地说状态，定义为数据的最小集合，这组数据足以唯一地描述系统的自然动态行为。换句话说，状态由预测系统未来特性时所素要的，与系统的过去行为有关的最少的数据组成。典型地，比较有代表性的情况是，状态x(n)是未知的。为了估计它，我们使用一组观测数据，在途中用向量y(n)表示。y(n)成为观测向量或者简称观测值，并假设它是N维的。在数学上，图3.1表示的信号流图隐含着一下两个方程：(1) 过程方程xn+1=Fn
9、+1,nxn+v1(n)(3.1)式中，M1向量v1(n)表示噪声过程，可建模为零均值的白噪声过程，且其相关矩阵定义为Ev1nv1Hk=Q1n n=kO nk(2) 测量方程yn=Cnxn+v2(n)(3.2)其中Cn是已知的NM测量矩阵。N1向量v2(n)称为测量噪声，建模为零均值的白噪声过程，其相关矩阵为Ev2nv2Hk=Q2n n=kO nk(3.3)测量方程(3.2)确立了可测系统输出yn与状态xn之间的关系，如图3.1所示。3.2 新息过程为了求解卡尔曼滤波问题，我们将应用基于新息过程的方法。根据之前所述，用向量y(n|yn-1)表示n=1时刻到n-1时刻所有观测数据过去值给定的情况
10、下，你时刻观测数据y(n)的最小均方估计。过去的值用观测值y1,y2,y(n-1)表示，他们张成的向量空间用yn-1表示。从而可以定义新息过程如下：n=yn-y(n|yn-1)(3.4)其中M1向量n表示观测数据yn的新息。3.3 应用新息过程进行状态估计下面，我们根据信息过程导出状态x(i)的最小均方估计。根据推导，这个估计可以表示成为新息过程1,2,n序列的线性组合，即xiyn=k=1nBik(k)(3.5)其中Bi(k)k=1n是一组待定的MN矩阵。根据正交性原理，预测状态误差向量与新息过程正交，即Ei,nHm=Exi-xiynH(m)=O(3.6)将式(3.5)代入式(3.6)，并利用
11、新息过程的正交性质，即得ExiHm=BimEmH(m)=BimR(m)(3.7)因此，式(3.7)两边同时右乘逆矩阵R-1(m)，可得Bim的表达式为Bim=ExiHmR-1(m)(3.8)最后，将式(3.8)带入式(3.5)，可得最小军方差估计xiyn=k=1nExiHkR-1(k)k=k=1n-1ExiHkR-1(k)k+ExiHnR-1(n)n(3.9)故对于i=n+1，有xn+1yn=k=1n-1Exn+1HkR-1(k)k+Exn+1HnR-1(n)n(3.10)然而，n+1时刻的状态x(n+1)与n时刻的状态x(n)的关系式由式可以推导出对于0kn，有Exn+1Hk=EFn+1,n
12、xn+v1nHk=Fn+1,nExnH(k)(3.11)其中k只与观测数据y1,y2,y(k)有关。因此可知，v1n与k彼此正交(其中0kn)。利用式(3.11)以及当i=n时xiyn的计算公式，可将式(3.10)右边的求和项改写为k=1n-1Exn+1HkR-1(k)k=Fn+1,nk=1n-1ExnHkR-1kk=F(n+1,n) xnyn-1(3.12)为了进一步讨论，引入如下基本定义。3.4 卡尔曼增益定义MN矩阵Gn=Ex(n+1)H(n) R-1(k)(3.13)其中Ex(n+1)H(n)是状态向量x(n+1)和新息过程(n)的互相关矩阵。利用这一定义和式(3.12)的结果，可以将
13、式(3.10)简单重写为xn+1yn= Fn+1,nxnyn-1+Gn(n)(3.14)式(3.14)具有明确的物理意义。它标明：线性动态系统状态的最小均方估计xn+1yn可以由前一个估计xnyn-1求得。为了表示对卡尔曼开创性贡献的认可，将矩阵Gn称为卡尔曼增益。现在剩下唯一要解决的问题是，怎样以一种便于计算的形式来表示卡尔曼增益Gn。为此，首先将x(n+1)与H(n)乘积的期望表示为Exn+1Hn=Fn+1,nExnHn,n-1CH(n)(3.15)式中利用了状态xn与噪声向量v2(n)互不相关这一事实。其次，由于预测状态误差向量(n,n-1)与估计xnyn-1正交，因此xnyn-1与Hn,n-1乘机的期望为零。这样，用预测状态误差向量(n,n-1)代替相乘因子xn，将不会引起式(3.15)变化，故有Exn+1Hn=Fn+1,nE(n,n-1)Hn,n-1CH(n)(3.16)由此，可将上式进一步变化为Exn+1Hn=Fn+1,nK(n,n-1)CH(n)(3.17)现在我们重新定义卡尔曼增益。为此，将式(3.17)代入式(3.13)得Gn=Fn+1,nK(n,n-1)CH(n) R-1(k)(3.18)现在我们已经了解了卡尔曼滤波的整个过程和相应的参数设置，为了能够更为方便利用计算机仿真实现，特将其中参数变量进行小结。卡尔曼变量和参数小结变量定义
