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

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

k=0,1,2,…其中:Xt(k)——k时刻目标t的状态向量；

初值Xt(0)是均值为、协方差矩阵为的随机

向量，且独立于Wt(k);Ft(k)——目标t的状态转移矩阵；41.模型k=0,1,2,…;t=1,2,…,Tk

Wt(k)——状态噪声，其均值为零的高斯白噪声，有协方差矩阵

E［Wt(k)(Wt(l))T］=Qt(k)δk,lH(k)——测量矩阵；V(k)——测量噪声，其均值为零的高斯白噪声，有协方差矩阵

E［Vt(k)(Vt(l))T］=Rt(k)δk,l

如果被跟踪的目标的关联门均不相交，或者没有回波处于相交区域，则多目标跟踪问题就可简化为多目标环境中的单目标跟踪问题。5Wt(k)——状态噪声，其均值为零的高斯白噪声，有2.确认矩阵的建立为了表示有效回波和个目标跟踪门的复杂关系，引入了确认矩阵的概念。当且仅当回波落入某目标关联区内，它才被认为是有效回波，否则被拒绝。实际上，只有落入关联门内的回波，被认为是有效回波。这样，我们就可以得到包括mk个有效回波，n个目标的有效矩阵或称确认矩阵。确认矩阵被定义为彼此相交的跟踪门的最大集合，表示为（6-1）62.确认矩阵的建立（6-1）6其结构如下:目标t012···n其中：ωjt表明第j个有效测量是否位于目标t的跟踪门内。t=0时，表明“没有目标”,相应的Ω矩阵中t=0对应的一列元素全部为1，每一个测量都可能来自于噪声、干扰或杂波相消剩余。矩阵中其余元素：当ωjt=1时，k时刻有效回波Zkj落入确认门Atk；当ωjt=0时，k时刻有效回波Zkj没落入确认门Atk。其中，j=1，2，…，mk；t=1，2，…，n。7其结构如下:目标t012··图1中目标数n=3，有效回波数mk=4，确认矩阵为：n=0,1,2,3mk

1234

第一个目标确认门内有两个有效回波Zk1，Zk2；第二个确认门内也有两个有效回波Zk2，Zk3；第三个确认门有一个有效回波Zk4，故ω11=1,ω21=1,ω22=1,ω32=1,ω43=1,其余为0。对于量测落入跟踪门相交区域的情形，对应某些量测可能源于多个目标，联合概率数据关联的目的就是计算每一个量测与其可能的各种源目标相关联的概率。8图1中目标数n=3，有效回波数mk=4，确认矩阵为：n=03.联合关联事件和联合关联概率为了进行状态估计，首先要解决mk个有效回波与n个目标配对的问题，即数据关联。JPDA算法的基本思想在于认为落入目标t的跟踪门内的有效回波都有可能来自目标t，只是其关联概率不同。93.联合关联事件和联合关联概率9首先定义关联事件θjt≡{有效测量Zj(k)来自目标t}j=1,2,…,mk;t=1,2,…,n当t=0时，θj0表示测量Zj(k)来自杂波或噪声的事件。记关联事件的后验概率为称βjt为关联概率，它是各关联事件出现可能性的度量。Zk表示全部有效回波的集合。10首先定义关联事件称βjt为关联概率，它是各关联事件出现可能性根据全概率公式，有其中，表示在时刻k利用卡尔曼滤波对目标t的状态估计。

上式表明，k时刻目标t的状态估计是其关联门内各个有效回波mk以相应的关联概率分别对目标t的状态估计的加权和。11根据全概率公式，有其中，表现定义联合关联事件表示第i个联合事件，它表示mk个量测源的一种可能。12现定义联合关联事件表示第i个联合事件，它表示mk个量测源的联合关联事件θi(k)可以表示成矩阵形式:其中,表示在联合事件中，量测j是否源于目标t。13联合关联事件θi(k)可以表示成矩阵形式:其中,表示在联满足以下两个条件的联合关联事件定义为可行事件：(1)

每个测量只能源于一个源、目标或杂波，即j=1,2,…,mk

(2)每个目标最多只能产生一个回波，即t=1,2,…,n

δt(θi(k))称为目标检测指示器，它表明事件θi(k)中是否

有测量与目标t关联，即目标是否被检测到。14满足以下两个条件的联合关联事件定义为可行事件：j=1,2同样可以定义一个测量关联指示器

j=1,2,…,mk

根据以上定义，联合事件θi(k)中未被关联的测量，即杂波的数目为:

它表明联合事件θi(k)中的测量j是否与一个真实的目标关联。15同样可以定义一个测量关联指示器j=1,2,…,mk可行事件θi(k)对应的矩阵

称为可行矩阵，由以上关于可能联合事件的讨论可以看出，它可以通过对确认矩阵拆分的方法得到：对确认矩阵Ω进行逐行扫描，每行仅选出一个1作为可行矩阵在该行的唯一非零元素。即满足每个量测有唯一的源。除第一列之外，可行矩阵中每列只能有一个1。即每个目标最多有一个量测以其为源。16可行事件θi(k)对应的矩阵例如：如图所示的最简单的多目标跟踪的例子：目标数n=2,有效回波数mk=3所对应的确认矩阵为：Z1(k)V1

Z3(k)V2

Z2(k)n=0,1,2mk

123根据以上确认矩阵的拆分原则，对其进行拆分，可以得到8个可行矩阵以及每个可行矩阵多对应的可行事件。17例如：如图所示的最简单的多目标跟踪的例子：Z1(k)V1（1）（2）18（1）（2）18（3）（4）19（3）（4）19（5）（6）20（5）（6）20（7）（8）21（7）（8）21通过以上拆分，共得到了8个可行的联合事件。由这8个可行的联合事件的组成，进而可以得到每一个量测与目标关联的事件：第一个量测与第一个目标关联的事件为：第一个量测不能与第二个目标关联。第二个量测与第一个目标关联的事件为：第二个量测与第二个目标关联的事件为：第三个量测与第二个目标关联的事件为：可行矩阵和可行联合事件是对应的。实际中一般通过拆分确认矩阵得到的可行矩阵来确定可行联合事件。22通过以上拆分，共得到了8个可行的联合事件。由这8个可行的联合6.1.3联合事件的概率计算在k时刻联合事件θ的条件概率：其中c为归一化常数。Bar-Shalom已经证明，对泊松分布杂波模型：23其中，c′为新归一化因子。6.1.3联合事件的概率计算在k时刻联合事件θ的条件概率：对均匀分布的杂波模型：式中，为均值为Ztj(k/k-1)，方差为Stj(k)的高斯分布。24最后有关联概率：

j=1,2,…,mk;t=1,2,…,T

没有一个有效测量源于目标t的概率：对均匀分布的杂波模型：式中，为均值为Ztj(k/k-1)给定初始值，Pt(0/0),t=1，2，…,n，递推公式

由k=1开始；(3)回波预测根据上面的结果，我们最后得到JPDA算法的流程如下：(4)预测协方差矩阵Pt(k/k-1)=Ft(k-1)Pt(k-1/k-1)［Ft(k-1)］T+Qt(k-1)25(2)预测状态给定初始值，Pt(0/0),t=1(5)预测新息向量(6)跟踪门限t=1,2,…,T

(7)根据有效回波集合，生成确认矩阵Ω，其中

如果Zkj落入关联门内否则j=1,2,…,mk;t=1,2,…,n

(8)由确认矩阵生成可行联合事件θi，i=1，2，…,L，L为可

行联合事件总和;26(9)计算可行联合事件概率P{θi/Zk}，i=1，2，…，L;

(10)计算关联概率,j=1,2,…,mk;t=1,2,…,n(5)预测新息向量(6)跟踪门限t=1,2,…,

(11)卡尔曼滤波公式其中，27(12)卡尔曼增益矩阵Kt(k)=Pt(k/k-1)Ht(k)［St(k)］-1

(13)滤波器协方差矩阵(14)令k=k+1，转步骤(2)。(11)卡尔曼滤波公式其中，27(12)卡尔曼增益28参考文献1.两类典型多目标跟踪算法的性能分析与比较2.基于一种改进IMMJPDA算法的地面目标跟踪3.一种改进的多传感器多目标跟踪联合概率数据关联算法研究28参考文献6.2多假设滤波器Reid于1977年根据多目标跟踪问题基于“全邻”最优滤波器和Bar—Shalom的确认矩阵的概念，提出了多假设跟踪方法。假设生成相关假设估计航迹平滑、保持假设管理航迹预测传感器数据航迹报告296.2多假设滤波器Reid于1977年根据多目标跟踪问题基多假设方法中的“假设”和联合概率数据关联中的联合事件的意义类似，不同的是：在形成假设时不仅对任一有效回波要考虑虚警的可能性，而且也要考虑新目标出现的可能性。K时刻的假设是由k-1时刻的假设和当前累积量测集合关联得到的。30多假设方法中的“假设”和联合概率数据关联中的联合事件的意义类6.2.1假设的产生和假设数的生成(1)与原有的一个假设关联，即zi(k)是一个航迹的继续。(2)zi(k)是一个新目标的量测，这时将产生一个新假设以起始的一

条航迹。(3)zi(k)源于虚警。316.2.1假设的产生和假设数的生成(1)与原有的一个假设关规则：每一个目标至多与一个落入跟踪门中的当前量测关联。举例说明假设树的生成：设(1)

zj(i)=FA表示第i个扫描周期的第j个量测源于虚警；(2)zj(i)=NTk表示第i个扫描周期的第j个量测源于新目标Tk；(3)zj(i)=Tk表示第i个扫描周期的第j个量测源于已经起始的航迹Tk。32规则：每一个目标至多与一个落入跟踪门中的当前量测关联。设32对于第一个扫描周期的第一个量测z1(1)有两种可能，构成了两种假设：H11(1)：z1(1)=FA，H12(1)：z1(1)=NT1

同理关于z2(1)也有两个假设：H21(1)：z2(1)=FA，H22(1)：z2(1)=NT233对于第一个扫描周期的第一个量测z1(1)有两种可能，构成了两由以上关于zi(1)的假设得到关于第一个扫描周期后累积量测集Z1的假设为：H1(1)：z1(1)=FA，z2(1)=FAH2(1)：z1(1)=FA，z2(1)=NT2H3(1)：z1(1)=NT1

，z2(1)=FA

H4(1)：z1(1)=NT1

，z2(1)=NT234由以上关于zi(1)的假设得到关于第一个扫描周期后累积量测集下面考虑第二个扫描周期的第一个量测z1(2)：(1)源于虚警；(2)源于第1个扫描周期已经起始的航迹T1；(3)源于第1个扫描周期已经起始的航迹T2；(4)源于一个新目标T3。对于第一种情况有4种假设：H11(2)：z1(1)=FA，z2(1)=FA，z1(2)=FAH12(2)：z1(1)=FA，z1(2)=NT2

，z1(2)=FAH13(2)：z1(1)=NT1

，z1(2)=FA，z1(2)=FAH14(2)：z1(1)=NT1

，z1(2)=NT2

，z1(2)=FA35下面考虑第二个扫描周期的第一个量测z1(2)：35对于第二种情况，因为在第一个扫描周期只有H3(1)和H4(1)有起始航迹T1所以有2种假设：H15(2)：z1(1)=NT1，z2(1)=FA，z1(2)=>T1

=

T3

H16(2)：z1(1)=NT1

，z1(2)=NT2

，z1(2)=>

T1

=

T3其中zi(j)

=>Tl

=

Ts表示第j个扫描周期的第i个量测源于已经起始的航迹Tl并更新到Ts同理对于第三种情况也有两个可能的假设：H17(2)：z1(1)=FA，z2(1)=NT2，z1(2)=>T2

=

T4H18(2)：z1(1)=NT1

，z2(1)=NT2，z1(2)=>T2

=

T436对于第二种情况，因为在第一个扫描周期只有H3(1)和H4(1对于第三种情况与第一种类似，也有4中假设：H19(2)：z1(1)=FA，z2(1)=FA，z1(2)=T5

H110(2)：z1(1)=FA，z1(2)=NT2

，z1(2)=T5H111(2)：

z1(1)=NT1

，z1(2)=FA，z1(2)=T5H112(2)：z1(1)=NT1

，z1(2)=NT2

，z1(2)=T5对于z2(2)也有类似的12种假设。37对于第三种情况与第一种类似，也有4中假设：37由以上关于zi(2)的假设得到关于第一个扫描周期后累积量测集Z2的假设为：H1(2)：z1(1)=FA，z2(1)=FA，z1(2)=FA，z2(2)=FAH2(2)：z1(1)=FA，z2(1)=NT2，z1(2)=FA，z2(2)=FAH3(2)：z1(1)=NT1

，z2(1)=FA，z1(2)=FA，z2(2)=FA

H4(2)：z1(1)=NT1

，z2(1)=NT2，z1(2)=FA，z2(2)=FAH5(2)：z1(1)=NT1

，z2(1)=FA，z1(2)=FA，z2(2)=>

T1

=

T6H6(2)：z1(1)=NT1

，z2(1)=NT2，z1(2)=FA，z2(2)=>

T1

=

T6……38由以上关于zi(2)的假设得到关于第一个扫描周期后累积量测集矩阵表示：假设第一个扫描周期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,6………………H34(2)12581,2,5,839矩阵表示：假第一个扫描周期第一个扫描周期假设中包含的航迹H1包含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)则包含航迹T1

、T2、T5、T840包含8条航迹：T1=z1(1)在每一个假设中可能包含多条航6.2.2假设估计设关于当前量测的事件q(k)包含t个源于已经建立航迹的量测，v个源于新目标的量测和F个源于虚警或杂波的量测。为了讨论方便引入关于q(k)的上述情形的指标变量：416.2.2假设估计设关于当前量测的事件q(k)包含t个源于从而在q(k)中已建立的航迹数为：从而在q(k)中起始的心新航迹数为：从而在q(k)中假量测数为：设Qk,l：表示k时刻的第l条航迹，则由假设生成的概念可得Qk,l是由Qk-1,s和q(k)关联得到的，即Qk,l={Qk-1,s

，q(k)}42从而在q(k)中已建立的航迹数为：从而在q(k)中起始的心新事件q(k)表示当前量测集z(k)中的量测与目标或杂波关联的一种可能