第六章 联合概率数据关联算法和多假设滤波器

1、数据融合第六章联合概率数据关联和多假设滤波器第六章u联合概率数据关联算法和多假设方法被认为是在多目标跟踪领域最有效的两种关联方法。u多假设跟踪方法考虑回波来源于目标、杂波和新目标等各种可能的情况。u联合概率数据关联算法是多假设方法的一个特例，避免了“最邻近”方法“唯一性”可能造成的关联出错，能够较好的适应密集环境下的多目标跟踪。2第六章6.1 联合概率数据关联算法6.1.1 联合概率数据关联算法的基本思想u联合概率数据关联算法是在仅适用于与单目标跟踪的概率数据关联算法(PDA)的基础上，提出的适用于多目标跟踪情形的一种数据关联算法。3第六章 1. 模型 假设在杂波环境中已有T个目标，则它们的状

2、态方程和测量方程分别表示为: )()()()()()()() 1(kVkXkHkZkWkXkFkXtttttk=0,1,2,; t=1,2,T k=0,1,2, 其中: Xt(k)k时刻目标t的状态向量； 初值Xt(0)是均值 为 、协方差矩阵为 的随机 向量，且独立于Wt(k); Ft(k)目标t的状态转移矩阵； )0/0(tX)0/0(tP4第六章 Wt(k)状态噪声，其均值为零的高斯白噪声，有协方差矩阵 EWt(k)(Wt(l)T=Qt(k)k,lH(k)测量矩阵；V(k)测量噪声，其均值为零的高斯白噪声，有协方差矩阵 EVt(k)(Vt(l)T=Rt(k)k,l 如果被跟踪的目标的关联

3、门均不相交，或者没有回波处于相交区域，则多目标跟踪问题就可简化为多目标环境中的单目标跟踪问题。 5第六章2. 确认矩阵的建立u为了表示有效回波和个目标跟踪门的复杂关系，引入了确认矩阵的概念。u当且仅当回波落入某目标关联区内，它才被认为是有效回波，否则被拒绝。u实际上，只有落入关联门内的回波，被认为是有效回波。这样，我们就可以得到包括mk个有效回波，n个目标的有效矩阵或称确认矩阵。确认矩阵被定义为彼此相交的跟踪门的最大集合，表示为ntmjkjt,.,1 , 0,.,2 , 1),(（6-1）6第六章u其结构如下:nmmmnnkkk212122111211111目标t0 1 2 n其中：jt表明第

4、j个有效测量是否位于目标t的跟踪门内。t=0时，表明“没有目标”,相应的矩阵中t=0对应的一列元素全部为1，每一个测量都可能来自于噪声、干扰或杂波相消剩余。 矩阵中其余元素： 01jt当jt=1时，k时刻有效回波Zkj落入确认门Atk；当jt=0时，k时刻有效回波Zkj没落入确认门Atk。其中，j=1，2，mk；t=1，2，n。 7第六章Zk4Zk3Zk1目标1目标2目标3Zk2图1中目标数n=3，有效回波数mk=4，确认矩阵为： n=0, 1, 2, 3 mk 1001010101110011k1234 第一个目标确认门内有两个有效回波Zk1，Zk2；第二个确认门内也有两个有效回波Zk2，Z

5、k3；第三个确认门有一个有效回波Zk4，故11=1, 21=1, 22=1, 32=1, 43=1, 其余为0。 对于量测落入跟踪门相交区域的情形，对应某些量测可能源于多个目标，联合概率数据关联的目的就是计算每一个量测与其可能的各种源目标相关联的概率。8第六章3.联合关联事件和联合关联概率u 为了进行状态估计，首先要解决mk个有效回波与n个目标配对的问题，即数据关联。uJPDA算法的基本思想在于认为落入目标t的跟踪门内的有效回波都有可能来自目标t，只是其关联概率不同。9第六章u首先定义关联事件ljt有效测量Zj(k)来自目标t j=1, 2, , mk; t=1, 2, , n 当t=0时，j

6、0表示测量Zj(k)来自杂波或噪声的事件。l记关联事件的后验概率为 /kjtjtZP称jt为关联概率，它是各关联事件出现可能性的度量。Zk表示全部有效回波的集合。 10第六章l根据全概率公式，有 kkmjtjjtkjtmjkjttkttkkxZkPZkkxEZkxEkkx00)/()| )(),(| )(| )()/(其中， 表示在时刻k利用卡尔曼滤波对目标t的状态估计。上式表明，k时刻目标t的状态估计 是其关联门内各个有效回波mk以相应的关联概率分别对目标t的状态估计的加权和。 )/(kkxtj)/(kkxt11第六章或虚警。个联合事件中源于杂波在第表示量测；其中的事件；个联合事件中源于目标

7、在第表示量测ijnttijkijijt00)(现定义联合关联事件 )()(1kkijtmjik 表示第i个联合事件，它表示mk个量测源的一种可能。12第六章否则0)()(1)(kkkiijtiijt联合关联事件i(k)可以表示成矩阵形式: kkiijtiimjkk,.,2 , 1;,.,2 , 1,)()(其中, 表示在联合事件中，量测j是否源于目标t。13第六章u满足以下两个条件的联合关联事件定义为可行事件： l(1) 每个测量只能源于一个源、 目标或杂波， 即 1)(0ntiijtkj=1, 2, , mk l(2) 每个目标最多只能产生一个回波，即 1)()(1kmjiijtitkkt=

8、1, 2, , n ut(i(k) )称为目标检测指示器，它表明事件i(k)中是否 有测量与目标t关联，即目标是否被检测到。ttjttjkjjit使若不存在使若存在, 0, 1)(14第六章u同样可以定义一个测量关联指示器 0, 00, 1)()(0jjintijtijttkkj=1, 2, , mk u根据以上定义，联合事件i(k)中未被关联的测量，即杂波的数目为: 它表明联合事件i(k)中的测量j是否与一个真实的目标关联。kmjijikk1)(1)(15第六章u可行事件i(k)对应的矩阵 称为可行矩阵，由以上关于可能联合事件的讨论可以看出，它可以通过对确认矩阵拆分的方法得到：l对确认矩阵进

9、行逐行扫描，每行仅选出一个1作为可行矩阵在该行的唯一非零元素。即满足每个量测有唯一的源。l除第一列之外，可行矩阵中每列只能有一个1。即每个目标最多有一个量测以其为源。)(ki16第六章例如：u如图所示的最简单的多目标跟踪的例子：u目标数n=2,有效回波数mk=3u所对应的确认矩阵为：Z1 (k)V1 Z3(k)V2 Z2(k)n=0, 1, 2 mk 101111011123根据以上确认矩阵的拆分原则，对其进行拆分，可以得到8个可行矩阵以及每个可行矩阵多对应的可行事件。17第六章（1）都源于杂波，即)(),(),(,001001001)(2211kzkzkzk)()()()()(1301201

10、1011kkkkk为：所对应的可行联合事件（2）都源于杂波，即，源于目标)(),(1)(,001001010)(2212kzkzkzk)()()()()(23022021122kkkkk为：所对应的可行联合事件18的事件；个联合事件中源于目标在第表示量测tijkijt)(第六章（3）源于杂波，即、分别源于目标)(, 21)(),(,001100010)(3213kzkzkzk)()()()()(33032231133kkkkk为：所对应的可行联合事件（4）源于杂波，即、分别源于目标)(, 21)(),(,100001010)(2314kzkzkzk)()()()()(43242041144kk

11、kkk为：所对应的可行联合事件19第六章（5）即源于杂波，源于目标,)(),(, 1)(,001010001)(3125kzkzkzk)()()()()(53052151055kkkkk为：所对应的可行联合事件（6）即源于杂波，分别源于目标,)(2 , 1)(),(,100010001)(1326kzkzkzk)()()()()(63262161066kkkkk为：所对应的可行联合事件20第六章（7）即源于杂波源于目标,)(),(, 2)(,001100001)(3127kzkzkzk)()()()()(73072271077kkkkk为：所对应的可行联合事件（8）即源于杂波，源于目标,)()

12、,(2)(,100001001)(2138kzkzkzk)()()()()(83282081088kkkkk为：所对应的可行联合事件21第六章u通过以上拆分，共得到了8个可行的联合事件。由这8个可行的联合事件的组成，进而可以得到每一个量测与目标关联的事件：l第一个量测与第一个目标关联的事件为：l第一个量测不能与第二个目标关联。l第二个量测与第一个目标关联的事件为：l第二个量测与第二个目标关联的事件为：l第三个量测与第二个目标关联的事件为：)()()()(41131121111kkkk)()()(62152121kkk)()()(72232222kkk)()()()(83263243232kkk

13、k可行矩阵和可行联合事件是对应的。实际中一般通过拆分确认矩阵得到的可行矩阵来确定可行联合事件。22第六章6.1.3 联合事件的概率计算在k时刻联合事件的条件概率： ,/ )(1/,/ )(1),(/1111PZkZPcZPZkZPcZkZPZPkkkkk其中c为归一化常数。Bar-Shalom已经证明，对泊松分布杂波模型：tkjtDTtttDmjjjtkPPkZNcZP111)1 ()()(/23其中， c为新归一化因子。 第六章对均匀分布的杂波模型： tkjjtDTtttDmjjtkPPkZNvcZP111)1 ()()(!1/式中， )(),1/();()(kSkkZkZNkZNtjtjj

14、jtj为均值为Ztj(k/k-1)，方差为Stj(k)的高斯分布。 24最后有关联概率： )(/jtkjtZPj=1, 2, , mk; t=1, 2, ,T 没有一个有效测量源于目标t的概率： Jjjtt10第六章(1) 给定初始值 ，Pt(0/0), t=1，2， , n， 递推公式 由k=1开始；) 0/0(tX) 1/1() 1() 1/(kkXkFkkXttt(3) 回波预测 ) 1/()() 1/(kkXkHkkZtt根据上面的结果， 我们最后得到JPDA算法的流程如下： (4) 预测协方差矩阵 Pt(k/k-1)=Ft(k-1)Pt(k-1/k-1)Ft(k-1)T+Qt(k-1

15、) 25(2) 预测状态 第六章(5) 预测新息向量 ) 1/()()(kkZkZkVtjtj(6) 跟踪门限 2tgt=1, 2, , T (7) 根据有效回波集合，生成确认矩阵，其中 01jt 如果Zkj落入关联门内否则j=1, 2, , mk; t=1, 2, , n (8) 由确认矩阵生成可行联合事件i，i=1，2，, L，L为可 行联合事件总和; 26(9) 计算可行联合事件概率Pi/Zk，i=1，2，L; (10) 计算关联概率, )(/1ijtLikijtZPj=1, 2, , mk;t=1, 2, , n第六章 (11) 卡尔曼滤波公式 )()() 1/()/(kVkKkkXk

16、kXtttt其中， jtjjttkVkV)()(27(12) 卡尔曼增益矩阵 Kt(k)=Pt(k/k-1)Ht(k)St(k)-1 (13) 滤波器协方差矩阵 TTTT0)()()()( )()()()()()1 () 1/()/(kKkVkVkVkVkKkKkSkKkkPkkPttttjjtjjtttttttt (14) 令k=k+1， 转步骤(2)。 第六章28u参考文献l1.两类典型多目标跟踪算法的性能分析与比较l2.基于一种改进IMMJPDA算法的地面目标跟踪l3.一种改进的多传感器多目标跟踪联合概率数据关联算法研究第六章6.2 多假设滤波器uReid于1977年根据多目标跟踪问题基

17、于“全邻”最优滤波器和BarShalom的确认矩阵的概念，提出了多假设跟踪方法。假设生成相关假设估计航迹平滑、保持假设管理航迹预测传感器数据航迹报告29第六章u多假设方法中的“假设”和联合概率数据关联中的联合事件的意义类似，不同的是：l在形成假设时不仅对任一有效回波要考虑虚警的可能性，而且也要考虑新目标出现的可能性。lK时刻的假设是由k-1时刻的假设和当前累积量测集合关联得到的。30第六章6.2.1 假设的产生和假设数的生成时刻的关联假设集。表示时刻的累积量测集；表示直到测；次扫描中所得到一组量表示第，设kkkZZZZkmikzkZkkki)(),.,2(),1 (,.,2 , 1)()(列三

18、种可能：和一个假设的关联有下量测关联而得到的。和当前量测集的关联假设集时刻是由与目标或杂波相关联，中的假设把累积量测集)()(11 -kzkZkZikkkk(1)与原有的一个假设关联，即zi(k)是一个航迹的继续。(2) zi(k)是一个新目标的量测，这时将产生一个新假设以起始的一 条航迹。(3) zi(k)源于虚警。31第六章u规则：每一个目标至多与一个落入跟踪门中的当前量测关联。u举例说明假设树的生成：)2(),1 (2ZZZ 设2 , 1)(),()(21iiziziZ，其中设(1) zj(i)=FA表示第i个扫描周期的第j个量测源于虚警；(2) zj(i)=NTk表示第i个扫描周期的第

19、j个量测源于新目标Tk；(3) zj(i)=Tk表示第i个扫描周期的第j个量测源于已经起始的航迹Tk 。32第六章u对于第一个扫描周期的第一个量测z1(1)有两种可能，构成了两种假设：lH11(1)： z1(1)=FA， H12(1)： z1(1)=NT1 u同理关于z2(1)也有两个假设：lH21(1)： z2(1)=FA， H22(1)： z2(1)=NT2一个目标。两个量测不可能源于同，在同一个扫描周期的注意21TT 33第六章u由以上关于zi(1)的假设得到关于第一个扫描周期后累积量测集Z1的假设为：lH1(1)： z1(1)=FA， z2(1)=FAlH2(1)： z1(1)=FA，

20、 z2(1)=NT2lH3(1)： z1(1)=NT1 ， z2(1)=FAl H4(1)： z1(1)=NT1 ， z2(1)=NT234第六章u下面考虑第二个扫描周期的第一个量测z1(2)：l(1) 源于虚警；l(2)源于第1个扫描周期已经起始的航迹T1 ；l(3)源于第1个扫描周期已经起始的航迹T2 ；l(4)源于一个新目标T3 。u对于第一种情况有4种假设：lH11(2)： z1(1)=FA， z2(1)= FA， z1(2)= FAlH12(2)： z1(1)=FA， z1(2)=NT2 ， z1(2)= FAlH13(2)： z1(1)=NT1 ， z1(2)= FA， z1(2)

21、= FAlH14(2)： z1(1)=NT1 ， z1(2)= NT2 ，z1(2)= FA35第六章u对于第二种情况，因为在第一个扫描周期只有H3(1)和H4(1)有起始航迹T1所以有2种假设：lH15(2)： z1(1)= NT1，z2(1)= FA， z1(2)=T1 = T3l H16(2)：z1(1)=NT1 ，z1(2)=NT2 ，z1(2)= T1 = T3l其中zi(j) =Tl = Ts表示第j个扫描周期的第i个量测源于已经起始的航迹Tl并更新到Tsu同理对于第三种情况也有两个可能的假设：lH17(2)： z1(1)=FA ， z2(1)= NT2 ， z1(2)=T2 =

22、T4lH18(2)： z1(1)=NT1 ，z2(1)= NT2 ， z1(2)=T2 = T436第六章u对于第三种情况与第一种类似，也有4中假设：lH19(2)： z1(1)=FA， z2(1)= FA， z1(2)= T5l H110(2)： z1(1)=FA， z1(2)=NT2 ， z1(2)= T5lH111(2)： z1(1)=NT1 ， z1(2)= FA， z1(2)= T5lH112(2)： z1(1)=NT1 ， z1(2)= NT2 ，z1(2)= T5u对于z2(2)也有类似的12种假设。37第六章u由以上关于zi(2)的假设得到关于第一个扫描周期后累积量测集Z2的假

23、设为：lH1(2)： z1(1)=FA， z2(1)=FA ， z1(2)=FA， z2(2)=FAlH2(2)： z1(1)=FA， z2(1)=NT2 ， z1(2)=FA， z2(2)=FAlH3(2)： z1(1)=NT1 ， z2(1)=FA ， z1(2)=FA， z2(2)=FAl H4(2)： z1(1)=NT1 ， z2(1)=NT2 ， z1(2)=FA， z2(2)=FAlH5(2)： z1(1)=NT1 ， z2(1)= FA ， z1(2)=FA， z2(2)= T1 = T6lH6(2)： z1(1)=NT1 ， z2(1)= NT2 ， z1(2)=FA， z2(

24、2)= T1 = T6 38第六章矩阵表示：假设第一个扫描周期 z1(1) z2(1)第一个扫描周期 z1(1) z2(1)假设中包含的航迹H1(2)00000H2(2)02002H3(2)10001H4(2)12001,2H5(2)1001(6)6H6(2)1201(6)2,6H34(2)12581,2,5,839第六章包含8条航迹：T1 =z1(1)T2 =z2(1) T3 =（z1(1)， z1(2)）T4 =（z2(1)， z1(2)）T5=z2(1)T6 =（z1(1)， z2(2)）T7 =（z2(1)， z2(2)）T8 =z2(2)在每一个假设中可能包含多条航迹，如:H34(2

25、)则包含航迹T1 、T2 、 T5 、 T840第六章6.2.2 假设估计u设关于当前量测的事件(k)包含个源于已经建立航迹的量测，v个源于新目标的量测和个源于虚警或杂波的量测。u为了讨论方便引入关于(k)的上述情形的指标变量：其它源于已建立的航迹如果, 0)(, 1)(kzkiii其它源于一个新目标如果, 0)(, 1)(kzkvviii其它源于虚警或杂波如果, 0)(, 1)(kzkiii41第六章l从而在(k)中已建立的航迹数为：)(1kmiil从而在(k)中起始的心新航迹数为：)(1kmiivvl从而在(k)中假量测数为：)(1)(kmiivkmu设Qk,l：表示k时刻的第l条航迹，则由假设生成的概念可得Qk,l是由Qk-1,s和(k)关联得到的，即Qk,l Qk-1,s ，(k) 42第六章u事件(k)表示当前量测集z(k)中的量测与目标或杂波关联的一种可能的情形，从而(k)可以表示为： k= T(k) ， N(k)， F(k) 其中关联的航迹。表示与，)()()(1kztkkiiiiTiit起始的新航迹。表示由，)()()(1kznkkiiviiNiin源于杂波或虚警。表示由，)(0)()(00kzkkiviiFii43第六章u以下我们计算每个可能假设的概率，我们的兴趣是试图导出假设Qk,l的概率和假