拓展卡尔曼滤波说课讲解.docx

《拓展卡尔曼滤波说课讲解.docx》由会员上传分享，免费在线阅读，更多相关内容在教育资源-天天文库。

1、拓展卡尔曼滤波精品文档南京航空航天大学随机信号小论文题目扩展卡尔曼滤波学生姓名梅晟学号SX1504059学院电子信息工程学院专业通信与信息系统收集于网络，如有侵权请联系管理员删除精品文档扩展卡尔曼滤波一、引言20世纪60年代，在航空航天工程突飞猛进而电子计算机又方兴未艾之时，卡尔曼发表了论文《ANewApproachtoLinearFilteringandPredictionProblems》（一种关于线性滤波与预测问题的新方法），这让卡尔曼滤波成为了时域内有效的滤波方法，从此各种基于卡尔曼滤波

2、的方法横空出世，在目标跟踪、故障诊断、计量经济学、惯导系统等方面得到了长足的发展。二、卡尔曼滤波器卡尔曼滤波是一种高效率的递归滤波器(自回归滤波器),它能够从一系列的不完全及包含噪声的测量中，估计动态系统的状态。卡尔曼滤波的一个典型实例是从一组有限的，包含噪声的，对物体位置的观察序列（可能有偏差）预测出物体的位置的坐标及速度。卡尔曼在NASA埃姆斯研究中心访问时，发现他的方法对于解决阿波罗计划的轨道预测很有用，后来阿波罗飞船的导航电脑便使用了这种滤波器。目前,卡尔曼滤波已经有很多不同的实现。卡尔

3、曼最初提出的形式现在一般称为简单卡尔曼滤波器。除此以外，还有施密特扩展滤波器、信息滤波器以及很多Bierman,Thornton开发的平方根滤波器的变种。也许最常见的卡尔曼滤波器是锁相环，它在收音机、计算机和几乎任何视频或通讯设备中广泛存在。三、扩展卡尔曼滤波器3.1被估计的过程信号卡尔曼最初提出的滤波理论只适用于线性系统,Bucy，Sunahara等人提出并研究了扩展卡尔曼滤波(ExtendedKalmanFilter，简称EKF)，将卡尔曼滤波理论进一步应用到非线性领域。EKF的基本思想是将

4、非线性系统线性化，然后进行卡尔曼滤波，因此EKF是一种次优滤波。收集于网络，如有侵权请联系管理员删除精品文档同泰勒级数类似，面对非线性关系时，我们可以通过求过程和量测方程的偏导来线性化并计算当前估计。假设过程具有状态向量x∈Rn，其状态方程为非线性随机差分方程的形式。xk=fxk-1,uk-1,wk-1(1.1)观测变量z∈Rm为：zk=h(xk,vk)(1.2)随机变量wk和vk代表过程激励噪声和观测噪声。它们为相互独立，服从正态分布的白色噪声：p(w)∼N(0,Q),p(v)∼N(0,R).

5、实际系统中，过程激励噪声协方差矩阵Q和观测噪声协方差矩阵R可能会随每次迭代计算而变化。但在这我们假设它们是常数。差分方程式(1.1)中的非线性函数f将过去k−1时刻状态与现在k时刻状态联系起来。量测方程(1.2)中的驱动函数uk和零均值过程噪声wk是它的参数。非线性函数h反映了状态变量xk和观测变量zk的关系。实际中我们显然不知道每一时刻噪声wk和vk各自的值。但是，我们可以将它们假设为零，从而估计状态向量和观测向量为：xk=fxk-1,uk-1,0(1.3)和zk=h(xk,0)(1.4)其中

6、，xk是过程相对前一时刻k的后验估计。收集于网络，如有侵权请联系管理员删除精品文档有一点非常重要，那就是扩展卡尔曼滤波器的一个基本缺陷：离散随机变量的分布（或连续随机变量的密度）在经过非线性系统转化后不再是正态的了。扩展卡尔曼滤波器其实就是一个通过线性化而达到渐进最优贝叶斯决策的特殊状态估计器。3.2滤波器的计算原型为了估计一个具有非线性差分和量测关系的过程，我们先给出式(1.3)和 式(1.4)的一个新的线性化表示：xk≈xk+Axk-1-xk-1+Wwk-1(1.5)zk≈zk+Hxk-xk

7、+Vvk(1.6)其中， •xk和zk是状态向量和观测向量的真值， •xk和zk来自1.3式和1.4式，是状态向量和观测向量的近似值， •xk是k时刻状态向量的后验估计， •随机变量wk和vk表示过程激励噪声和观测噪声。 •A是f对x的偏导的雅可比矩阵：A[i,j]=∂fi∂xjxk-1,uk-1,0•W是f对w的偏导的雅可比矩阵：W[i,j]=∂fi∂wjxk-1,uk-1,0•H是h对x的偏导的雅可比矩阵：H[i,j]=∂hi∂xjxk,0•V是h对v的偏导的雅可比矩阵：V[i,j]=∂hi

8、∂vjxk,0现在我们定义一个新的预测误差的表达式：收集于网络，如有侵权请联系管理员删除精品文档exk≡xk-xk(1.7)和观测变量的残余，ezk≡zk-zk(1.8)但实际中无法获得(1.7)式中的xk,它是状态向量的真值，也就是要估计的对象。同样，(1.8)式中的zk也是无法获取的，它是用来估计xk的观测向量的真值。由(1.7)式和(1.8)式我们可以写出误差过程的表达式：exk≈Axk-1-xk-1+ϵk(1.9)ezk≈Hexk+ηk(1.10)ϵk和ηk代表具有零均值和协方差矩阵WQ