kalman滤波在运动跟踪中建模.pdfVIP

目录 一、 kalman 滤波简介 1 二、 kalman 滤波基本原理 1 三、 Kalman滤波在运动跟踪中的应用的建模 3 四、仿真结果 6 1、kalman 的滤波效果 6 2、简单轨迹的 kalman 的预测效果 7 3、椭圆运动轨迹的预测 9 4、往返运动归轨迹的预测 10 五、参数的选取 11 附录： 13 Matlab 程序： 13 C语言程序： 13 Kalman滤波在运动跟踪中的应用 一、 kalman 滤波简介 最佳线性滤波理论起源于 40 年代美国科学家 Wiener 和前苏联科学家Ｋол могоров等人的研究工作， 后人统称为维纳滤波理论。 从理论上说， 维纳 滤波的最大缺点是必须用到无限过去的数据， 不适用于实时处理。 为了克服这一 缺点，60 年代 Kalman把状态空间模型引入滤波理论，并导出了一套递推估计算 法，后人称之为卡尔曼滤波理论。 卡尔曼滤波是以最小均方误差为估计的最佳准 则，来寻求一套递推估计的算法， 其基本思想是： 采用信号与噪声的状态空间模 型，利用前一时刻地估计值和现时刻的观测值来更新对状态变量的估计， 求出现 时刻的估计值。它适合于实时处理和计算机运算。 Kalman滤波是卡尔曼 (R.E.kalman) 于 1960年提出的从与被提取信号的有关 的观测量中通过算法估计出所需信号的一种滤波算法。 他把状态空间的概念引入 到随机估计理论中， 把信号过程视为白噪声作用下的—个线性系统的输出， 用状 方程来描述这种输入—输出关系， 估计过程中利用系统状态方程、 观测方程和白 噪声激励 ( 系统噪声和观测噪声 ) 的统计特性形成滤波算法， 由于所用的信息都是 时域内的量，所以不但可以对平稳的一维随机过程进估计，也可以对非平稳的、 多维随机过程进行估汁。 Kalman 滤波是一套由计算机实现的实时递推算法．它所处理的对象是随机 信号，利用系统噪声和观测噪声的统计特性， 以系统的观测量作为滤波器的输入， 以所要估计值 ( 系统的状态或参数 ) 作为滤波器的输出， 滤波器的输入与输出之间 是由时间更新和观测更新算法联系在一起的， 根据系统方程和观测方程估计出所 有需要处理的信号。所以， Kalman 滤波与常规滤波的涵义与方法不同，它实质 上是一种最优估计法。 卡尔曼滤波器是一个“ optimal recursive data processing algorithm （最 优化自回归数据处理算法） ，对于解决很大部分的问题，他是最优，效率最高甚 至是最有用的 二、 kalman 滤波基本原理 Kalman 滤波器是目标状态估计算法解决状态最优估计的一种常用方法具有 计算量小、存储量低、实时性高的优点。实际应用中，可以将物理系统的运行过 程看作是一个状态转换过程， 卡尔曼滤波将状态空间理论引入到对物理系统的数 学建模过程中来。 其基本思想是给系统信号和噪声的状态空间建立方程和观测方 程，只用信号的前一个估计值和最近一个观察值就可以在线性无偏最小方差估计 准则下对信号的当前值做出最优估计。 设一系统所建立的模型为： 状态方程：个离散控制过程的系统，