基于IMM算法的目标跟踪.doc

《基于IMM算法的目标跟踪.doc》由会员上传分享，免费在线阅读，更多相关内容在行业资料-天天文库。

1、西安交通大学多源信息融合---IMM算法基于交互式多模型方法的目标跟踪高海南3110038011一、目标建模我们设定一个目标在二维平面内运动，其状态由位置、速度和加速度组成，即。假设采样间隔为，目标检测概率，无虚警存在，在笛卡尔坐标系下目标的离散运动模型和观测模型(假定在采样时刻)为：目标在二维平面内运动模型如下：1.CV:近似匀速运动模型CV模型将加速度看作是随机扰动（状态噪声），取目标状态。则状态转移矩阵，干扰转移矩阵和观测矩阵分别为：，2.CT：匀速转弯模型只考虑运动角速度已知的CT模型。则状态转移矩阵，干扰转移矩阵和观

2、测矩阵分别为：量测噪声协方差矩阵由传感器决定。二、交互多模算法原理13西安交通大学多源信息融合---IMM算法假定有个模型：其中，是均值为零、协方差矩阵为的白噪声序列。用一个马尔可夫链来控制这些模型之间的转换，马尔可夫链的转移概率矩阵为：测量模型为：IMM算法步骤可归纳如下：①、输入交互其中，是模型转到模型的转移概率，为规一化常数，。②、对应于模型，以，及作为输入进行Kalman滤波。1）预测2）预测误差方差阵3）卡尔曼增益4）滤波5）滤波误差方差阵13西安交通大学多源信息融合---IMM算法③、模型概率更新其中，为归一化常数

3、，且，而为观测的似然函数，。④、输出交互一、仿真实验设定目标运动起始位置坐标（x，y）为（1000,1000），初始速度为（10,10），采样间隔T=1s，CT模型运动的角速度，即做顺时针匀速转弯运动。x和y独立地进行观测，观测标准差为50米。目标在1~150s运动模型为CV，151~270s运动模型为CT，271~400s运动模型为CV。目标运动真实轨迹和测量轨迹如图1所示。13西安交通大学多源信息融合---IMM算法图1目标运动轨迹在IMM滤波时，使用2个模型集，即CV、CT，假设我们已经知道CT模型的目标运动角速度w，M

4、arkov转移矩阵。进行蒙特卡洛仿真，得到IMM滤波结果。将此滤波结果与单独的CV、CT模型的标准卡尔曼滤波结果对比，如图2所示。由图可知，CT模型滤波结果与真实值有较大偏差，在转弯时CV模型卡尔曼滤波结果偏离偏离真实值，而IMM算法能较好的跟踪目标。图2各种滤波结果图为了定量分析滤波结果，我们将X、Y方向的CV、CT卡尔曼滤波、IMM滤波与真实值分别求位置偏差、均方根误差并进行进行对比，如图3、图4所示。同时作出各个时刻CV、CT的模型概率，如图5所示。可以看到在转弯时刻（151~270s）期间，CT模型概率大于CV模型概率

5、，此时IMM滤波主要取决于CT模型，而在其他时刻，CT模型起主要作用，这与我们的经验知识一致。IMM算法就是通过各模型概率的自动调整来完成对机动目标的跟踪，相对于单一模型滤波具有较理想的跟踪精度。13西安交通大学多源信息融合---IMM算法图3位置滤波偏差图4位置滤波均方根误差13西安交通大学多源信息融合---IMM算法图5各时刻CV、CT模型概率1、下面讨论不同的马尔科夫一步转移矩阵对跟踪结果的影响。（1）时，模型概率和滤波结果如下图所示，此时CV、CT模型概率变化趋势不变，但相差不大，显然IMM算法优于单模型Kalman滤

6、波算法，但其精度低于当转移矩阵为P1时的结果。图6转移矩阵为P2时概率变化图13西安交通大学多源信息融合---IMM算法图7转移矩阵为P2时滤波结果图（2）更极端地，取时，模型概率和滤波结果如下图所示，此时CV、CT模型概率变化趋势总体不变，但相差甚微，而IMM算法总体上仍优于单模型Kalman滤波算法，但其精度同样低于当转移矩阵为P1和P2时的结果。图8转移矩阵为P3时概率变化图13西安交通大学多源信息融合---IMM算法图9转移矩阵为P3时滤波结果图综上所述，Markov链状态转移矩阵对角线元素越大，即由k-1时刻模型m1

7、转移到k时刻模型m1概率越大，也就是模型的“惯性”越大，交互式多模型滤波结果精度越高，反之，精度越低。2、CT模型角速度对滤波结果的影响取Markov转移矩阵，而角速度，其他参数均不变，仿真得到如下结果，与图2对比可知，当角速度越接近于真实值，跟踪精度越高，反之跟踪精度有所下降。图10角速度=-pi/360时滤波结果图13西安交通大学多源信息融合---IMM算法通过编写程序和仿真实验结果可以体会到，IMM算法核心在于对做复杂机动运动的目标滤波时，IMM能够通过对各个模型滤波器的输入输出通过混合概率和似然函数计算进行加权综合处理

8、，自动切换模型，实现对目标的较好跟踪。IMM算法跟踪性能好坏取决于其使用的模型集，模型越精确，模型集越丰富，跟踪效果就越好，但带来了计算量增加的问题，有时反而降低性能。13西安交通大学多源信息融合---IMM算法附：IMM滤波程序produce_data.m13西安交通大学多