行人跟踪算法

行人跟踪算法行人跟踪是在车辆正常运行过程中实时的跟踪检测到的行人的算法。在实际应用中，仅仅使用行人检测很难有效的满足行人检测的实时性和稳定性。因此对行人检测的跟踪是十分必要的。行人跟踪一般是通过对检测到的行人区域进行颜色和纹理的分析。目前对于行人跟踪问题的主要研究方法有：卡尔曼滤波跟踪方法和均值偏移跟踪方法。1.卡尔曼滤波跟踪算法卡尔曼滤波在近20年来取得了长足的发展。把目标的位置，速度和加速度作为目标状态矢量，通过目标的动力学方程来描述目标状态的变化，利用递推的计算方法，目标的状态可以方便的估计出来，这样目标的航迹就可以建立起来。建立在非线性运动模型上的卡尔曼滤波称为扩展的卡尔曼滤波。在雷达跟踪系统中，我们所用到的是离散型卡尔曼滤波。离散卡尔曼滤波的状态方程，测量方程以及推广方程如下：状态方程：X(k)=4(k,k-1)X(k-1)+「(k/k-1)w(k-1)(2.1)测量方程：Z成)=H(k)X(k)+v(k)(2.2)式中：X(k)为所要进行估计的状态值，4(k/k-1)为状态转移矩阵，w(k)为协方差矩阵为Q的状态噪声，H(k)为测量转移矩阵，v(k)为协方差矩阵为R的测量噪声。状态预测方程：X(k/k-1)=4(k/k-1)X(k-1/k-1)(2.3)预测估计值协方差矩阵：P(k/k-1)=4(k/k-1)P(k-1/k-1)4t(k/k-1)+T(k/k-1)Q(k-1)「t(k/k-1)(2.4)增益矩阵：TOC\o"1-5"\h\z\o"CurrentDocument"K(k)=P(k/k-1)Ht(k)[H(k)P(k/k-1)Ht(k)+R(k)]-1(2.5)滤波估计值：\o"CurrentDocument"X(k/k)=X(k/k-1)+k(k)[Z(k)-H(k)X(k/k-1)](2.6)滤波估计值协方差矩阵：\o"CurrentDocument"P(k/k)=P(k/k-1)-k(k)H(k)P(k/k-1)(2.7)一.一--"..・......人.....一■-.在卡尔曼滤波过程中，只有确定了状态估计初始值X(0)和滤波估计值协方差矩阵的初始值P(0)，整个滤波过程才能启动。一般情况下，我们将初始估计值X(0)的值定为整个系统的第一次观测值Z(0)，将滤波估计值的协方差矩阵P(0)的初始值可以拟订为一个对角阵，虽然大多数实际情况并非如此，但是这样做也是符合理论要求的，并且对于我们的运算也有简化作用。从上面性质的直观分析可知，增益阵K与Q成正比，与R成反比。我们可以归纳为：当R越大，测量噪声越大，因此测量值不准确性更大，所以K要变小，以保证测量值在最后估计结果中所占的比重比较小；而Q比较大的时候，说明状态噪声比较大，因此预测值受状态噪声干扰比较严重，所以K值比较大，以保证预测值在最后估计结果中所占的比重比较小。状态噪声越大，状态噪声协方差矩阵Q的值越大，这样更有利于捕捉目标机动状态，滤波收敛速度快，减少丢失跟踪的概率，但是这样所得到的滤波结果精度比较差；相反，状态噪声越小，状态噪声协方差矩阵Q的值越小，这样所得到的滤波结果精度比较好，但是滤波收敛速度慢，当目标发生大机动状态运动时，丢失跟踪的可能性比较大。本文正是利用Q矩阵的这种作用，对在保证一定卡尔曼滤波精度的前提下加快滤波收敛速度做了算法改进。2.均值偏移跟踪算法均值偏移(meanshift)由Fukunaga等人在1975年有关概率密度梯度函数估计的一篇文章中提出，它是一种基于非参数统计的算法，它利用核密度估计，使得各点向密度较大的分布中心演化，即先算出当前点均值偏移，移动该点到其偏移均值，然后以此为新的起点，继续移动，直到满足一定的条件结束oMeanShift算法通过迭代运算收敛于概率密度函数的局部最大值，实现目标定位和跟踪，也能对可变形状目标实时跟踪，对目标的变形，旋转等运动也有较强的鲁棒性。MeanShift算法是一种自动迭代跟踪算法，由MeanShift补偿向量不断沿着密度函数的梯度方向移动。在一定条件下，MeanShift算法能收敛到局部最优点，从而实现对运动体准确地定位°Meanshift跟踪速度较好，在已知目标区域的前提下能达到实时跟踪，同时由于采用核函数的直方图，对目标的少量变形不敏感，故应用范围较广。给定d维空间腥中的n个样本点七，i=1,…，n,在x点的MeanShift向量的基本形式定义为：M(x)三LZ(x-x)xeSih其中，七是一个半径为h的高维球区域，满足以下关系的y点的集合,S(x)=E:(y-x》(y-x)<h2}k表示在这n个样本点七中，有k个点落入七区域中.可以看到(xt-x)是样本点七相对于点X的偏移向量，⑴式定义的MeanShift向量Mh(x)就是对落入区域七中的k个样本点相对于点x的偏移向量求和然后再平均.图1,MeanShift示意图如上图所示，大圆圈所圈定的范围就是