Kalman滤波在运动跟踪中的应用整理

1、Kalman滤波在运动跟踪中的应用一 kalman滤波简介Kalman滤波是卡尔曼（R.E.kalman）丁 1960年提出的从与被提取信号的有关 的观测量中通过算法估计出所需信号的一种滤波算法。他把状态空间的概念引入 到随机估计理论中，把信号过程视为白噪声作用下的一个线性系统的输出，用状方程来描述这种输入一输出关系，估计过程中利用系统状态方程、观测方程和白 噪声激励（系统噪声和观测噪声）的统计特性形成滤波算法，由丁所用的信息都是 时域内的量，所以不但可以对平稳的一维随机过程进估计，也可以对非平稳的、 多维随机过程进行估汁。Kalman滤波是一套由计算机实现的实时递推算法.它所处理的对象是随机

2、 信号，利用系统噪声和观测噪声的统计特性，以系统的观测量作为滤波器的输入， 以所要估计值（系统的状态或参数）作为滤波器的输出，滤波器的输入与输出之间 是由时间更新和观测更新算法联系在一起的， 根据系统方程和观测方程估计出所 有需要处理的信号。所以，Kalman滤波与常规滤波的涵义与方法不同，它实质 上是一种最优估计法。二kalman滤波基本原理Kalman滤波器是目标状态估计算法解决状态最优估计的一种常用方法具有 计算量小、存储量低、实时性高的优点。实际应用中，可以将物理系统的运行过 程看作是一个状态转换过程，卡尔曼滤波将状态空间理论引入到对物理系统的数 学建模过程中来。其基本思想是给系统信号

3、和噪声的状态空间建立方程和观测方 程，只用信号的前一个估计值和最近一个观察值就可以在线性无偏最小方差估计 准则下对信号的当前值做出最优估计。设一系统所建立的模型为：状态方程：Xk =AkiXk】 Wk观测方程：Zk =HkXk Vk其中，Xk为k时刻系统特征的状态向量，Zk为观测向量,Ak=为状态由k-1 时刻到k时刻的转移矩阵，Hk从为观测矩阵,Wk为k时刻系统输入随机噪声向 量，Vk为观测噪声向量，其中A和Hk为状态变换过程中用来调整状态的系数， 为已知矩阵。一般系统随机噪声和观测噪声符合高斯白噪声的过程， 因此假设它 们的概率密度函数是均值为零的高斯函数且相互独立。设 Wk, Vk它们的

4、方差分 别为Qk和Rk,初始状态与Wk和Vk不相关,则Wk(0, Qk), Vk(0, Rk)。随机系统的状态估计问题，就是根据选定的估计准则和获取的观测信息对系 统状态进行估计。Kalman预估计采用递推的方法来实现对状态的估计。它在先 不考虑系统和观测噪声的前提下获得状态的先验估计，并以此推算当前的状态变量。这是没有考虑噪声的情形下获得的估计值与真实值有一定得误差，然后用状态先验估计和观测变量的加权线性组合构成后验状态估计，当后验状态估计协方差误差取得最小时即获得对状态的最优估计。用文k表示对状态的最优估计，文'k表示状态先验估计，Pk'表示先验估计误差方差矩阵，Pk表示状

5、态最优估计的误 差方差矩阵，Kk为使状态获得最优估计时的系数矩阵，称为Kalman增益。Kalman 滤波器实现的主要五个方程为：(1) 状态向量预报方程 X'k = AXki(2) 状态向量协方差预报方程P'k=AkPkA： Q“Kalman加权矩阵(或增益矩阵) TTKk =Pk'H：(HkPk'HT Rk)(4) 状态向量更新方程 Xk =X'k+Kk(Zk -HkX'k)(5) 状态向量协方差更新方程Pk =(I - KkHQPk'Kalman滤波预估计就是用前面两个时间更新方程获得先验估计然后通过后 面三个状态更新方程对先验估计

6、矫正获得最优估计。三Kalman滤波在运动跟踪中的应用卡尔曼滤波器是一个对动态系统的状态序列进行线性最小误差估计的算法， 一般用丁线性系统。一般在运动跟踪领域中摄像机相对丁目标物体运动有时届丁 非线性系统，但由丁在一般运动跟踪问题中图像采集时间间隔较短，可近似将单位时间内目标在图像中的运动看作匀速运动， 采用卡尔曼滤波器可以实现对目标 运动参数的估计。对丁复杂背景下运动目标识别与跟踪问题，要实现实时控制，对算法的实时 性和准确性都有较高的要求。通常的目标识别算法都是基丁像素的全局搜索，从目前实践来看，该方法存在显著缺点：1)全局搜索计算量大、耗时，实时性无法满足；2）全局搜索抗干扰能力差，容易

7、受到背景中相似特征物体的干扰。基丁卡 尔曼滤波器预测功能的运动目标快速跟踪算法可以通过预测目标物体在下一帧 中的位置，将全局搜索问题转化为局部搜索，提高算法的实时性。3.1应用实例在移动机器人跟踪运动目标的过程中， 由丁目标物体单位时间内在图像中的 运动可以看作匀速运动，所以可以采用目标某一时刻在图像中的位置和速度来表 示目标的运动状态。为了简化算法的计算复杂度，可以设计了 2个卡尔曼滤波器 分别描述目标在X轴和Y轴方向上位置和速度的变化。下面仅讨论 X轴方向上 卡尔曼滤波器的实现过程，Y轴方向上同理。目标物体运动方程为：Xk* =Xk 十VkTVk + = Vk +a式中Xk , Vk ,

8、ak分别为目标在t=k时刻的X轴方向的位置、速度和加速度；T为k帧图像和k+1帧图像之间的时间间隔，akT可以当作白噪声处理。写成矩 阵形式如下：系统状态方程为：T Xk，Xk +sj I。1AV1卡尔曼滤波器系统状态欠量为:Xk =Xk VkT状态转移矩阵为：H(k)=系统动态噪声欠量为:Wk0WkT系统观测方程为:Xk i = 10XkVk卡尔曼滤波器系统观测欠量为:Zk =Xk观测系数矩阵为:Hk0 1由观测方程可知，观测噪声为 0,所以&=0。建立了上述系统状态方程和观测方程之后，就可以利用卡尔曼滤波方程式通 过递推方法，不断预测目标在下一帧中的位置。在 t=k时刻，对第k帧图像利用目标识别算法识别出的目标位置记为当目标首次出现时，根据此时目标的、一 观测位置初始化滤波器X'o=Xo , 0。系统初始状态向量协方差矩阵可以在对角线上取较大值，取值根据实际测量情况来获得，但在滤波启动一段时间后影响就不大了。取：10 0、0 10,系统动态噪声协方差为Qo,可取为:Qo10 03 10 X'l。在该位置附近，Zi，通过公式（2）至公通过公式（1）,计算得到目标在下一帧图像中的预测位置 对下一帧图像进行局部搜索