自19世纪80年代Pearl[1]首次提出信度传播算法以来,越来越多的学者逐渐将其作为解决雷达多目标跟踪问题的一种新思路[2],其中Meyer等[3-4]将迭代信度传播算法应用在多传感器多目标跟踪环境中,并提出粒子数值实现方式.但现阶段的研究内容只针对于低杂波背景环境,在实际的战场环境中,一方面存在大量低信噪比、运动形式复杂的目标,加大了检测难度;另一方面雷达信号处理器的检测输出存在虚警或漏检,产生大量的剩余杂波和干扰等,易发生误跟、失跟等现象[5].因此需要对密集杂波环境下信度传播多目标跟踪算法的性能进行深入研究.
随着雷达和多传感器技术的逐渐成熟,不仅可以得到目标在空间中的位置、速度和加速度等运动信息,还可以获得幅度信息、回波宽度信息和多普勒速度信息等,因此有学者提出知识辅助的多目标跟踪方法.其中幅度信息最早在1990年由Lerro等[6]指出,将幅度信息与PDA算法结合,证明了该方法的有效性.为了更准确的体现在复杂跟踪环境中杂波长拖尾情况,2009年Brekke等[7]在K分布幅度模型下将幅度信息应用到JPDA算法中,通过计算具体的幅度似然比提高数据关联效率,得到了更好的杂波抑制效果.在国内, 文献[8-9]也将幅度信息分别引入PDA和JPDA算法中,改善了多目标跟踪性能.除此之外也有学者以类似的方法将幅度信息分别引入多假设跟踪算法[10]、多伯努利滤波器[11]和概率假设密度滤波器[12]等,在不同的数据关联算法中均得到了较好的跟踪效果.
在此基础上,国内外学者也对信噪比进行了深入研究.一般情况下均假设目标信噪比已知,且保持不变,或者假设目标信噪比在规定区间内服从均匀分布.为了更加充分体现目标信噪比的波动情况,Bae等[13]提出一种基于序贯蒙特卡洛方法的新型SNR估计算法,证明了该方法的有效性和高精度性,随后又提出了一种基于最大后验估计的SNR估计算法[14],并与极大似然估计方法对比发现该方法的估计效果更强.
本文提出基于幅度杂波抑制的高斯混合信度传播多目标跟踪算法.首先基于瑞利分布幅度模型和极大似然估计法,依据先验信息构造截断正态分布信噪比模型;然后结合幅度信息,一方面引入幅度似然比,提高信度传播过程中目标与量测的关联效率,另一方面设置量测信息录取率,提高目标起始效率;最后通过仿真实验对比,验证本文算法在密集杂波环境下的高效性.
1 幅度信息幅度信息(amplitude information,AI)即回波的强度信息,由于杂波与目标的幅度概率密度函数有显著的不同,因此基于该特性可区分杂波和目标.令量测的幅度信息为l,当只有杂波时幅度信息的概率密度函数为pc(l),目标信噪比为dt,当目标存在时幅度信息的概率密度函数为pt(l|dt),幅度检测门限为τ,检测概率为PDτ(dt),虚警概率为PFAτ,本文依据文献[6]中的瑞利分布描述杂波和目标的幅度变化,相关公式详见文献[6].
由于在实际情况中目标信噪比具有一定程度的不确定性,需要对目标信噪比进行深入研究.本文首先产生n个样本的幅度信息,其中令n足够大,随后依据该样本对目标的初始信噪比进行极大似然估计为
$ {{\hat d}_{\rm{t}}} = \mathop {\text{ argmax}}\limits_d \sum\limits_{i = 1}^n {\ln } \left[ {{p_{\rm{t}}}\left( {{l_i}|d} \right)} \right] = \frac{1}{{2n}}\left( {\sum\limits_{i = 1}^n {l_i^2} } \right) - 1, $ |
得到目标初始信噪比的估计值
$ p\left( d \right) = \left\{ {\begin{array}{*{20}{l}} {C\frac{1}{{\sqrt {2{\rm{ \mathsf{ π} }}} {\sigma _{\rm{t}}}}}\exp \left( { - \frac{{{{\left( {d - {\hat d_{\rm{t}}}} \right)}^2}}}{{2\sigma _{\rm{t}}^2}}} \right),d \in \left[ {{d_{{\rm{low}}}},{d_{{\rm{high}}}}} \right];}\\ {0,{\rm{ otherwise}}{\rm{. }}} \end{array}} \right. $ |
参数C保证p(d)在区间[dlow, dhigh]内的累计概率为1,根据标准正态分布的累计分布函数Φ(·)计算可得到C为
$ C = {\left[ {\mathit{\boldsymbol{ \boldsymbol{\varPhi} }}\left( {\frac{{{d_{{\rm{high}}}} - {{\hat d}_{\rm{t}}}}}{{{\sigma _{\rm{t}}}}}} \right) - \mathit{\boldsymbol{ \boldsymbol{\varPhi} }}\left( {\frac{{{d_{{\rm{low}}}} - {{\hat d}_{\rm{t}}}}}{{{\sigma _{\rm{t}}}}}} \right)} \right]^{ - 1}}. $ |
由于检测概率PDτ(dt)和有效幅度概率密度函数ptτ(l|dt)均与信噪比有关,则依据目标信噪比模型进行边缘化处理,得到不以目标信噪比为参数的检测概率PDτ和有效幅度概率密度函数ptτ(l)为:
$ \begin{array}{l} P_{\rm{D}}^\tau = \int_{{d_{{\rm{low}}}}}^{{d_{{\rm{high}}}}} p \left( \delta \right)P_{\rm{D}}^\tau \left( \delta \right){\rm{d}}\delta = \\ \;\;\;\;\;\;\;\frac{C}{{\sqrt {2{\rm{ \mathsf{ π} }}} {\sigma _{\rm{t}}}}}\int_{{d_{{\rm{low}}}}}^{{d_{{\rm{high}}}}} {\exp } \left[ {\frac{{ - {{\left( {\delta - {{\hat d}_{\rm{t}}}} \right)}^2}}}{{2\sigma _{\rm{t}}^2}} - \frac{{{\tau ^2}}}{{2\left( {1 + \delta } \right)}}} \right]{\rm{d}}\delta , \end{array} $ | (1) |
$ \begin{array}{l} p_{\rm{t}}^\tau \left( l \right) = \int_{{d_{{\rm{low}}}}}^{{d_{{\rm{high}}}}} p (\delta )p_{\rm{t}}^\tau (l|\delta ){\rm{d}}\delta = \\ \;\;\;\;\;\;\;\;\;\frac{C}{{\sqrt {2{\rm{ \mathsf{ π} }}} {\sigma _{\rm{t}}}}}\int_{{d_{{\rm{low}}}}}^{{d_{{\rm{high}}}}} {\frac{l}{{1 + \delta }}} \exp \left[ {\frac{{\left( {{\tau ^2} - {l^2}} \right)}}{{2(1 + \delta )}} - \frac{{{{\left( {\delta - {{\hat d}_{\rm{t}}}} \right)}^2}}}{{2\sigma _{\rm{t}}^2}}} \right]{\rm{d}}\delta . \end{array} $ | (2) |
最终得到截断正态分布信噪比模型下的幅度似然比为
$ \begin{array}{l} \rho \left( {l,\tau } \right) = \frac{C}{{\sqrt {2{\rm{ \mathsf{ π} }}} {\sigma _{\rm{t}}}}}\exp \left( {\frac{{{l^2} - {\tau ^2}}}{2}} \right) \times \\ \;\;\;\;\;\;\;\;\;\;\;\;\;\int_{{d_{{\rm{low}}}}}^{{d_{{\rm{bigh}}}}} {\frac{1}{{1 + \delta }}} \exp \left[ {\frac{{\left( {{\tau ^2} - {l^2}} \right)}}{{2\left( {1 + \delta } \right)}} - \frac{{{{\left( {\delta - {{\hat d}_{\rm{t}}}} \right)}^2}}}{{2\sigma _{\rm{t}}^2}}} \right]{\rm{d}}\delta ,l \ge \tau . \end{array} $ | (3) |
基于信度传播的多目标跟踪算法主要是将马尔科夫随机场理论与多目标跟踪问题结合,构造信度传播因子图模型,得到目标増广状态的信度函数,在此基础上判断目标的存在性,并对目标的状态进行估计,本文主要依据文献[3]建立多目标跟踪的马尔科夫随机场模型及相关方程.
假设目标个数为K,引入目标序号下标k∈{1, …, K},定义第n时刻第k个目标的増广状态向量为yn.k
假设传感器个数为S,引入传感器序号下标s∈{1, …, S},定义第n时刻第s个传感器的量测个数为Mn(s),引入量测信息序号下标m∈{1, …, Mn(s)},第n时刻第s个传感器的第m个量测信息为zn, m(s),第n时刻第s个传感器的Mn(s)个量测形成了联合量测向量zn(s)
令第n时刻在第s个传感器中第k个目标的分配变量为an, k(s)∈{0, 1, …, Mn(s)},若第k个目标未产生量测即漏检an, k(s)=0,若第k个目标产生了序号为m的量测则an, k(s)=m.为了与分配变量对应,引入冗余分配变量bn, m(s)∈{0, 1, …, K},若第n时刻在第s个传感器中第m个量测是虚警则bn, m(s)=0,若第m个量测来源于序号为k的目标则bn, m(s)=k,信度传播多目标跟踪算法的因子图模型如图 1所示.
图 1中:
本文首先对系统模型扩维,令第n时刻第k个目标增广状态为yn, k
依据信度传播多目标跟踪算法的粒子数值实现方式[4],给出并完善高斯混合数值实现方式,令第n-1时刻第k个目标状态用高斯三元组集合表示,即{(wn-1, k(i), mn-1, k(i), Pn-1, k(i))}i=1Jn-1, k,则第n-1时刻第k个目标信度函数的高斯和形式为:
$ \tilde f\left( {{\mathit{\boldsymbol{x}}_{n - 1,k}},1} \right) = \sum\limits_{i = 1}^{{J_{n - 1,k}}} {w_{n - 1,k}^{\left( i \right)}} N\left( {{\mathit{\boldsymbol{x}}_{n,k}};\mathit{\boldsymbol{m}}_{n - 1,k}^{\left( i \right)},\mathit{\boldsymbol{P}}_{n - 1,k}^{\left( i \right)}} \right), $ |
$ \tilde f\left( {{\mathit{\boldsymbol{x}}_{n - 1,k}},0} \right) = \left( {1 - \sum\limits_{i = 1}^{{J_{n - 1,k}}} {w_{n - 1,k}^{(i)}} } \right){f_{\rm{D}}}\left( {{\mathit{\boldsymbol{x}}_{n - 1,k}}} \right). $ |
式中fD(xn-1, k)为虚拟函数.
3.1 预测步令第n-1时刻得到的存活目标集合为Кn-1, s,新生目标集合为Кn-1, b,存活概率为ps,分别对存活目标和新生目标进行一步预测.
当xn-1, ks∈ Кn-1, s时,可得:
$ {\alpha _{\rm{s}}}\left( {{\mathit{\boldsymbol{x}}_{n,{k_{\rm{s}}}}},1} \right) = \sum\limits_{i = 1}^{{J_{n - 1}},{k_{\rm{s}}}} {w_{n|n - 1,{k_{\rm{s}}}}^{(i)}} N\left( {{\mathit{\boldsymbol{x}}_{n,{k_{\rm{s}}}}};\mathit{\boldsymbol{m}}_{n|n - 1,{k_{\rm{s}}}}^{(i)},\mathit{\boldsymbol{P}}_{n|n - 1,{k_{\rm{s}}}}^{(i)}} \right), $ |
$ {\alpha _{\rm{s}}}\left( {{\mathit{\boldsymbol{x}}_{n,{k_s}}},0} \right) = \left( {1 - \sum\limits_{i = 1}^{{J_{n - 1,{k_{\rm{s}}}}}} {w_{n - 1,{k_{\rm{s}}}}^{(i)}} } \right){f_{\rm{D}}}\left( {{\mathit{\boldsymbol{x}}_{n,{k_{\rm{s}}}}}} \right), $ |
其中,存活目标三元组分别为:
$ w_{n\left| {n - 1} \right.,{k_{\rm{s}}}}^{\left( i \right)} = {p_{\rm{s}}}w_{n - 1,{k_{\rm{s}}}}^{\left( i \right)}, $ |
$ \mathit{\boldsymbol{m}}_{n|n - 1,{k_{\rm{s}}}}^{\left( i \right)} = {\mathit{\boldsymbol{F}}_{n - 1}}\mathit{\boldsymbol{m}}_{n - 1,{k_s}}^{\left( i \right)}, $ |
$ \mathit{\boldsymbol{P}}_{n|n - 1,{k_{\rm{s}}}}^{(i)} = {\mathit{\boldsymbol{Q}}_{n - 1}} + {\mathit{\boldsymbol{F}}_{n - 1}}\mathit{\boldsymbol{P}}_{n - 1,{k_{\rm{s}}}}^{(i)}\mathit{\boldsymbol{F}}_{n - 1}^{\rm{T}}, $ |
则存活目标最终所有的高斯分量个数为Jn, ks=Jn-1, ks,最终信度函数可表示为{(wn, ks(i), mn, ks(i), Pn, ks(i))}i=1Jn, ks~α(yn, ks).
当xn-1, kb∈Кn-1, b时,可得:
$ {\alpha _{\rm{b}}}\left( {{\mathit{\boldsymbol{x}}_{n,{k_{\rm{b}}}}},1} \right) = \sum\limits_{j = 1}^{{J_{\beta ,n - 1}},{k_{\rm{b}}}} {w_{\beta ,n|n - 1,{k_{\rm{b}}}}^{(j)}} N\left( {{\mathit{\boldsymbol{x}}_{n,{k_{\rm{b}}}}};\mathit{\boldsymbol{m}}_{n|n - 1,{k_{\rm{b}}}}^{(j)},\mathit{\boldsymbol{P}}_{n|n - 1,{k_{\rm{b}}}}^{(j)}} \right), $ |
$ {\alpha _{\rm{b}}}\left( {{\mathit{\boldsymbol{x}}_{n,{k_{\rm{b}}}}},0} \right) = \left( {1 - \sum\limits_{j = 1}^{{J_{\beta ,n - 1}},{k_{\rm{b}}}} {w_{\beta ,n|n - 1,,{k_{\rm{b}}}}^{(j)}} } \right){f_{\rm{D}}}\left( {{\mathit{\boldsymbol{x}}_{n,{k_b}}}} \right). $ |
其中,新生目标三元组分别为
$ w_{\beta ,n|n - 1,{k_{\rm{b}}}}^{(j)} = {p_{\rm{s}}}w_{\beta ,n - 1,{k_{\rm{b}}}}^{(j)}, $ |
$ \mathit{\boldsymbol{m}}_{n|n - 1,{k_{\rm{b}}}}^{(j)} = {\mathit{\boldsymbol{F}}_{n - 1}}\mathit{\boldsymbol{m}}_{n - 1,{k_{\rm{b}}}}^{(j)}, $ |
$ \mathit{\boldsymbol{P}}_{n|n - 1,{k_{\rm{b}}}}^{(j)} = {\mathit{\boldsymbol{Q}}_{n - 1}} + {\mathit{\boldsymbol{F}}_{n - 1}}\mathit{\boldsymbol{P}}_{n - 1,{k_{\rm{b}}}}^{(j)}\mathit{\boldsymbol{F}}_{n - 1}^{\rm{T}}, $ |
则新生目标最终所有的高斯分量个数为Jn, kb=Jβ, n-1, kb,最终信度函数可表示为
$ \left\{ {\left( {w_{n,{k_{\rm{b}}}}^{(j)},\mathit{\boldsymbol{m}}_{n,{k_{\rm{b}}}}^{(j)},\mathit{\boldsymbol{P}}_{n,{k_{\rm{b}}}}^{(j)}} \right)} \right\}_{j = 1}^{{J_n},{k_{\rm{b}}}} \sim \alpha \left( {{\mathit{\boldsymbol{y}}_{n,{k_{\rm{b}}}}}} \right). $ |
当得到存活目标与新生目标的一步预测后,各目标其余的步骤同基于信度传播的多目标跟踪算法基本保持一致,因此在本文所提算法在剩下的步骤中不再区分新生目标与存活目标,统一令第n时刻第k个目标通过预测步后最终的高斯分量个数为Jn, k,且最终经预测步后得到的信度函数为{(wn, kα(j), mn, kα(j), Pn, kα(j))}j=1Jn, k~α(yn, k), 基于幅度杂波抑制的高斯混合信度传播多目标跟踪的具体流程如图 2所示.
在该步骤中传感器量测信息函数主要由量测似然函数和杂波分布函数构成,计算各幅度信息的幅度似然比并引入该信息函数,较准确地得到与目标对应的量测信息.第n时刻对第k个目标预测的信度函数分别进入各传感器中,其中对于第s个传感器中的第k个目标,其先验分配向量信息为
$ \begin{array}{l} \beta \left( {a_{n,k}^{(s)}} \right) = \sum\limits_{j = 1}^{{J_{n,k}}} v \left( {{\mathit{\boldsymbol{x}}_{n,k}},1,a_{n,k}^{(s)};\mathit{\boldsymbol{\tilde z}}_n^{(s)}} \right)w_{n,k}^{\alpha (j)} + \\ \;\;\;\;\;\;\;\;\;\;\;\;\;v\left( {{\mathit{\boldsymbol{x}}_{n,k}},0,a_{n,k}^{(s)};\mathit{\boldsymbol{\tilde z}}_n^{(s)}} \right)\left( {1 - \sum\limits_{j = 1}^{{J_{n,k}}} {w_{n,k}^{\alpha (j)}} } \right). \end{array} $ |
在各传感器中,将与目标状态有关的检测概率首先转化为与目标信噪比相关,再依据式(1)选择将目标信噪比边缘化后的检测概率为
$ P_{\rm{D}}^{(s)}\left( {{\mathit{\boldsymbol{x}}_{n,k}}} \right) = P_{\rm{D}}^\tau \left( {{d_{\rm{t}}}} \right) = P_{\rm{D}}^\tau . $ |
令各传感器的虚警概率保持一致均为PFAτ,杂波数目服从参数为μ(s)的泊松分布,结合文献[6]可知杂波的空间分布函数为
$ {f_{\rm{C}}}\left( {\mathit{\boldsymbol{\tilde z}}_{n,m}^{\left( s \right)}} \right) = {f_{\rm{C}}}\left( {\mathit{\boldsymbol{\mathord{\buildrel{\lower3pt\hbox{$\scriptscriptstyle\frown$}} \over z} }}_{n,m}^{\left( s \right)}} \right){p_{\rm{c}}}\left( {l_{n,m}^{\left( s \right)}} \right), $ |
结合式(2)量测似然函数为:
$ f\left( {\mathit{\boldsymbol{\tilde z}}_{n,m}^{\left( s \right)}|{\mathit{\boldsymbol{x}}_{n,k}}} \right) = f\left( {\mathit{\boldsymbol{\mathord{\buildrel{\lower3pt\hbox{$\scriptscriptstyle\frown$}} \over z} }}_{n,m}^{(s)}|{\mathit{\boldsymbol{x}}_{n,k}}} \right)p_t^\tau \left( {l_{n,m}^{(s)}} \right), $ |
$ f\left( {\mathit{\boldsymbol{\mathord{\buildrel{\lower3pt\hbox{$\scriptscriptstyle\frown$}} \over z} }}_{n,m}^{(s)}|{\mathit{\boldsymbol{x}}_{n,k}}} \right) = N\left( {\mathit{\boldsymbol{\mathord{\buildrel{\lower3pt\hbox{$\scriptscriptstyle\frown$}} \over z} }}_{n,m}^{(s)};{\mathit{\boldsymbol{\sigma }}_{n,k}},{\mathit{\boldsymbol{S}}_{n,k}}} \right), $ |
结合式(3),代入幅度似然比,得到第s个传感内的量测信息函数为:
$ v\left( {{\mathit{\boldsymbol{x}}_{n,k}},1,a_{n,k}^{(s)};\mathit{\boldsymbol{\tilde z}}_n^{(s)}} \right) =\\ \left\{ \begin{array}{l} \frac{{P_{\rm{D}}^{(s)}\left( {{\mathit{\boldsymbol{x}}_{n,k}}} \right)\sum\limits_{j = 1}^{{J_{n,k}}} {w_{n,k}^{\alpha (j)}} N\left( {\mathit{\boldsymbol{\tilde z}}_{n,m}^{(s)}|\mathit{\boldsymbol{\sigma }}_{n,k}^{(j)},\mathit{\boldsymbol{S}}_{n,k}^{(j)}} \right)}}{{P_{{\rm{FA}}}^\tau {\mu ^{(S)}}{f_{\rm{C}}}\left( {\mathit{\boldsymbol{\tilde z}}_{n,m}^{(s)}} \right)}} = \frac{{P_{\rm{D}}^\tau \sum\limits_{j = 1}^{{J_{n,k}}} {w_{n,k}^{\alpha (j)}} N\left( {\mathord{\buildrel{\lower3pt\hbox{$\scriptscriptstyle\frown$}} \over z} _{n,m}^{(s)}|\mathit{\boldsymbol{\sigma }}_{n,k}^{(j)},\mathit{\boldsymbol{S}}_{n,k}^{(j)}} \right)p_{\rm{t}}^\tau \left( {l_{n,m}^{(s)}} \right)}}{{P_{{\rm{FA}}}^\tau {\mu ^{(S)}}{f_{\rm{C}}}\left( {\mathit{\boldsymbol{\mathord{\buildrel{\lower3pt\hbox{$\scriptscriptstyle\frown$}} \over z} }}_{n,m}^{(s)}} \right)p_{\rm{c}}^\tau \left( {l_{n,m}^{\left( s \right)}} \right)}} = \\ \frac{{P_{\rm{D}}^\tau \sum\limits_{j = 1}^{{J_{n,k}}} {w_{n,k}^{\alpha (j)}} N\left( {\mathord{\buildrel{\lower3pt\hbox{$\scriptscriptstyle\frown$}} \over z} _{n,m}^{(s)}|\mathit{\boldsymbol{\sigma }}_{n,k}^{(j)},\mathit{\boldsymbol{S}}_{n,k}^{(j)}} \right)}}{{P_{{\rm{FA}}}^\tau {\mu ^{(S)}}{f_{\rm{C}}}\left( {\mathit{\boldsymbol{\mathord{\buildrel{\lower3pt\hbox{$\scriptscriptstyle\frown$}} \over z} }}_{n,m}^{(s)}} \right)}}\rho \left( {l_{n,m}^{(s)},\tau } \right),a_{n,k}^{(s)} = m \in \left\{ {1, \cdots ,M_n^{(s)}} \right\},{r_{n,k}} = 1;\\ 1 - P_{\rm{D}}^{(s)}\left( {{x_{n,k}}} \right) = 1 - P_{\rm{D}}^\tau ,a_{n,k}^{(s)} = 0. \end{array} \right. $ |
$ v\left( {{\mathit{\boldsymbol{x}}_{n,k}},0,a_{n,k}^{(s)};\mathit{\boldsymbol{\tilde z}}_n^{(s)}} \right) = 1\left( {a_{n,k}^{(s)}} \right) = 1,a_{n,k}^{(s)} = 0. $ |
其中相关量测信息为:
$ \mathit{\boldsymbol{\sigma }}_{n,k}^{(j)} = {\mathit{\boldsymbol{H}}_n}\mathit{\boldsymbol{m}}_{n,k}^{\alpha (j)}, $ |
$ \mathit{\boldsymbol{S}}_{n,k}^{(j)} = {\mathit{\boldsymbol{R}}_n} + {\mathit{\boldsymbol{H}}_n}\mathit{\boldsymbol{P}}_{n,k}^{\alpha (j)}\mathit{\boldsymbol{H}}_n^{\rm{T}}. $ |
在量测估计步基础上对β(an, k(s))进行迭代信度传播,其中令迭代步数为Pmax,由Mn(s)个冗余分配分量节点向K个分配分量节点传播的信息为vm→k(p)(an, k(s))[3],由K个分配分量节点向Mn(s)个冗余分配分量节点传播的信息为ζk→m(p)(bn, m(s))[3],完成第n时刻完成Pmax步迭代后,返回第s个传感器第k个目标的分配向量信息为
$ \eta \left( {a_{n,k}^{(s)}} \right) = \prod\limits_{m = 1}^{M_n^{\left( s \right)}} {v_{m \to k}^{\left( {{P_{\max }}} \right)}} \left( {a_{n,k}^{(s)}} \right). $ |
完成迭代信度传播后,得到返回各传感器第k个目标的分配向量信息η(an, k(s)),对先验分配向量信息β(an, k(s))进行更新,即:
$ w_{n,k}^{A(j)} = w_{n,k}^{\alpha (j)}\prod\limits_{s = 1}^S {\sum\limits_{a_{n,k}^{(s)} = 0}^{M_n^{\left( s \right)}} v } \left( {{\mathit{\boldsymbol{x}}_{n,k}},1,a_{n,k}^{(s)};\mathit{\boldsymbol{\tilde z}}_n^{(s)}} \right)\eta \left( {a_{n,k}^{(s)}} \right),j \in {J_{n,k}}, $ |
$ w_{n,k}^B = \left( {1 - \sum\limits_{j = 1}^{{J_{n,k}}} {w_{n,k}^{\alpha \left( j \right)}} } \right)\prod\limits_{s = 1}^S \eta \left( {a_{n,k}^{(s)} = 0} \right),j \in {J_{n,k}}, $ |
则归一化后的高斯分量权重为
$ w_{n,k}^{(j)} = \frac{{w_{n,k}^{A(j)}}}{{\sum\limits_{{j^\prime } = 1}^{{J_{n,k}}} {w_{n,k}^{A\left( {{j^\prime }} \right)}} + w_{n,k}^B}}. $ |
考虑到高斯分量的特殊性,需要对所有的高斯分量进行剪枝融合操作,设置权重阈值wth,只保留wn, k(j)≥wth的高斯分量,令最大的高斯分量权重wmax=max(wn, k(j))j=1Jn, k,以wmax为基准将距离小于门限L的高斯分量进行融合,最终对于第k个目标只需保留一个高斯分量即
$ {\mathit{\boldsymbol{\sigma }}_{n,k}} = {\mathit{\boldsymbol{H}}_n}{{\mathit{\boldsymbol{\tilde m}}}_{n,k}}, $ |
$ {\mathit{\boldsymbol{S}}_{n,k}} = {\mathit{\boldsymbol{R}}_n} + {\mathit{\boldsymbol{H}}_n}{{\mathit{\boldsymbol{\tilde P}}}_{n,k}}\mathit{\boldsymbol{H}}_n^{\rm{T}}. $ |
随后分别在各传感器内,得到迭代信度传播后的分配向量为:
$ {\gamma ^{\left( s \right)}}\left( {{x_{n,k}},1} \right) = \sum\limits_{a_{n,k}^{\left( s \right)}} v \left( {{\mathit{\boldsymbol{x}}_{n,k}},1,a_{n,k}^{(s)};\mathit{\boldsymbol{\tilde z}}_n^{(s)}} \right)\eta \left( {a_{n,k}^{(s)}} \right), $ |
$ {\gamma ^{(s)}}\left( {{\mathit{\boldsymbol{x}}_{n,k}},0} \right) = \eta \left( {a_{n,k}^{(s)} = 0} \right). $ |
依据γ(s)(xn, k, 1)得到第s个传感器中所有量测信息分别对第k个目标的贡献权重wn, s(m), m∈{1, …, Mn(s)},则第k个目标的关联量测信息为:
$ \mathit{\boldsymbol{\bar z}}_{n,k}^{(s)} = \sum\limits_{m = 1}^{M_n^{(s)}} {w_{n,s}^{(m)}} \mathit{\boldsymbol{\mathord{\buildrel{\lower3pt\hbox{$\scriptscriptstyle\frown$}} \over z} }}_{n,m}^{(s)}, $ |
$ \mathit{\boldsymbol{\bar S}}_{n,k}^{(s)} = \sum\limits_{m = 1}^{M_n^{(s)}} {w_{n,s}^{(m)}} \left[ {{\mathit{\boldsymbol{S}}_{n,k}} + \left( {\mathit{\boldsymbol{\mathord{\buildrel{\lower3pt\hbox{$\scriptscriptstyle\frown$}} \over z} }}_{n,m}^{(s)} - {\mathit{\boldsymbol{\sigma }}_{n,k}}} \right){{\left( {\mathit{\boldsymbol{\mathord{\buildrel{\lower3pt\hbox{$\scriptscriptstyle\frown$}} \over z} }}_{n,m}^{(s)} - {\mathit{\boldsymbol{\sigma }}_{n,k}}} \right)}^{\rm{T}}}} \right]. $ |
式中:
首先将第n时刻所有传感器对第k个目标关联的量测信息进行融合,令:σn, kAUG为第n时刻第k个目标的増广预测量测信息矩阵;Hn, kAUG为増广量测矩阵;zn, kAUG是増广量测信息矩阵;Sn, kAUG为増广量测协方差矩阵,即:
$ \mathit{\boldsymbol{\sigma }}_{n,k}^{{\rm{AUG}}} = \left[ {{\mathit{\boldsymbol{\sigma }}_{n,k}}; \cdots ;{\mathit{\boldsymbol{\sigma }}_{n,k}}} \right], $ |
$ \mathit{\boldsymbol{H}}_{n,k}^{{\rm{AUG}}} = \left[ {{\mathit{\boldsymbol{H}}_n}; \cdots ;{\mathit{\boldsymbol{H}}_n}} \right], $ |
$ \mathit{\boldsymbol{z}}_{n,k}^{{\rm{AUG}}} = \left[ {\mathit{\boldsymbol{\bar z}}_{n,k}^{(1)}; \cdots ;\mathit{\boldsymbol{\bar z}}_{n,k}^{(S)}} \right], $ |
$ \begin{array}{l} \mathit{\boldsymbol{S}}_{n,k}^{{\rm{AUG}}} = \text{rep}\left( {{\mathit{\boldsymbol{S}}_{n,k}},S,S} \right) + \text{diag}\left( {\mathit{\boldsymbol{\bar S}}_{n,k}^{(1)}, \cdots ,\mathit{\boldsymbol{\bar S}}_{n,k}^{(S)}} \right) - \\ \;\;\;\;\;\;\;\;\;\;\;{\rm{diag}}\left( {{\mathit{\boldsymbol{S}}_{n,k}}, \cdots ,{\mathit{\boldsymbol{S}}_{n,k}}} \right). \end{array} $ |
式中:diag为分块对角矩阵函数,即构造以参数矩阵为对角线的分块对角矩阵;rep为重复矩阵函数,即构造S×S个分块的分块矩阵,每一个分块皆为参数矩阵.其中S是传感器数量.
然后对目标进行增广卡尔曼滤波为:
$ {\mathit{\boldsymbol{K}}_{n,k}} = {{\mathit{\boldsymbol{\tilde P}}}_{n,k}}{\left( {\mathit{\boldsymbol{H}}_{n,k}^{{\rm{AUG}}}} \right)^{\rm{T}}}{\left[ {\mathit{\boldsymbol{S}}_{n,k}^{{\rm{AUG}}}} \right]^{ - 1}}, $ |
$ {\mathit{\boldsymbol{P}}_{n,k}} = \left[ {\mathit{\boldsymbol{I}} - {\mathit{\boldsymbol{K}}_{n,k}}\mathit{\boldsymbol{H}}_{n,k}^{{\rm{AUG}}}} \right]{{\mathit{\boldsymbol{\tilde P}}}_{n,k}}, $ |
$ {\mathit{\boldsymbol{m}}_{n,k}} = {{\mathit{\boldsymbol{\tilde m}}}_{n,k}} + {\mathit{\boldsymbol{K}}_{n,k}}\left( {z_{n,k}^{{\rm{AUG}}} - \mathit{\boldsymbol{\sigma }}_{n,k}^{{\rm{AUG}}}} \right), $ |
$ {w_{n,k}} = {{\tilde w}_{n,k}}. $ |
设置概率阈值Pth,当wn, k>Pth时认为目标存在,且将该目标加入到该时刻的存活目标集合Кn, s中,该目标对应的三元组{(wn, k, mn, k, Pn, k)}将会在下一步的高斯混合信度传播中使用.
则第n时刻第k个目标的状态估计为
$ \mathit{\boldsymbol{\hat x}}_{n,k}^{{\rm{MMSE}}} = {\mathit{\boldsymbol{m}}_{n,k}}, $ |
第n时刻第k个目标存活概率为
$ p\left( {{r_{n,k}} = 1|z} \right) = {w_{n,k}}, $ |
第n时刻所有目标的数目估计为
$ {N_n} = \text{round}\left( {\sum\limits_{k = 1}^K {{w_{n,k}}} } \right). $ | (4) |
传感器的量测信息主要包括目标的真实量测和杂波的量测,这些量测信息均是通过幅度检测门限τ筛选得到的,认为这些量测信息录取率为1.但是通过筛选得到的量测信息仍然包含一些剩余杂波量测信息,这样在每个时间步长内需要为大量无用的量测信息独立添加新生目标,造成新生目标数量庞大,在密集的杂波干扰中进一步加大信度传播中数据关联的错误率.
本文定义一个量测信息录取率Plow,为简化算法运算量,依据极大似然估计得到的目标初始信噪比
$ {P_{{\rm{low}}}} \buildrel \Delta \over = \int_{{l_{{\rm{low}}}}}^\infty {p_{\rm{t}}^\tau } \left( {l|{{\hat d}_{\rm{t}}}} \right){\rm{d}}l \buildrel \Delta \over = \exp \left[ {\frac{{{\tau ^2} - l_{{\rm{low}}}^2}}{{2\left( {1 + {{\hat d}_{\rm{t}}}} \right)}}} \right]. $ |
从而得到幅度下限llow和幅度似然比下限ρlow,若量测的幅度似然比超过该下限值则直接录取进入目标起始过程,否则舍弃,即:
$ {l_{{\rm{low}}}} \buildrel \Delta \over = \sqrt {{\tau ^2} - 2\ln \left( {{P_{{\rm{low}}}}} \right)\left( {1 + {{\hat d}_{\rm{t}}}} \right)} , $ |
$ {\left. {{\rho _{{\rm{low}}}} \buildrel \Delta \over = \rho \left( {l,d,\tau } \right)} \right|_{{l_{{\rm{low}}}},{{\hat d}_{\rm{t}}},\tau }} \buildrel \Delta \over = \frac{1}{{1 + {{\hat d}_{\rm{t}}}}}\exp \left[ { - {{\hat d}_{\rm{t}}}\ln \left( {{P_{{\rm{low}}}}} \right)} \right]. $ |
在第n时刻第s个传感器得到Mn(s)个量测信息中,若第m个量测的幅度信息ln, m(s)满足ρ(ln, m(s),
$ \tilde f\left( {{\mathit{\boldsymbol{x}}_{n,{k_{\rm{b}}}}},1} \right) = {f_{\rm{b}}}\left( {{\mathit{\boldsymbol{x}}_{n,{k_{\rm{b}}}}}} \right) = \sum\limits_{j = 1}^{{J_{\beta ,n,{k_{\rm{b}}}}}} {w_{\beta ,n,{k_{\rm{b}}}}^{(j)}} N\left( {{\mathit{\boldsymbol{x}}_{n,{k_{\rm{b}}}}};\mathit{\boldsymbol{m}}_{n,{k_{\rm{b}}}}^{\left( j \right)},\mathit{\boldsymbol{P}}_{n,{k_{\rm{b}}}}^{\left( j \right)}} \right), $ |
$ \tilde f\left( {{\mathit{\boldsymbol{x}}_{n,{k_{\rm{b}}}}},0} \right) = \left( {1 - \sum\limits_{j = 1}^{{J_{\beta ,n,{k_{\rm{b}}}}}} {w_{\beta ,n,{k_{\rm{b}}}}^{\left( j \right)}} } \right){f_{\rm{D}}}\left( {{\mathit{\boldsymbol{x}}_{n,{k_{\rm{b}}}}}} \right). $ |
式中:
本文在不同的杂波密度和不同信噪比情况下进行50次蒙特卡洛仿真,对比分析高斯混合概率假设密度(Gaussian mixture probability hypothesis density, GMPHD)、高斯混合信度传播(Gaussian mixture belief propagation, GMBP)、基于幅度信息且信噪比已知的高斯混合信度传播(amplitude information and known SNR-based Gaussian mixture belief propagation, GMBP-AK)和基于幅度杂波抑制的高斯混合信度传播(amplitude clutter suppression-based Gaussian mixture belief propagation,GMBP-AC)多目标跟踪算法的目标数目估计误差、跟踪精度和仿真时间等,进一步验证本文所提GMBP-AC算法的高性能.
4.1 场景设置设定实验的三维背景仿真区域为[-3, 3] km× [-3, 3] km×[-3, 3] km,跟踪时间为100 s,时间步长Δt=1 s,目标存活概率ps=1,目标新生概率pb=0.01,量测更新过程中权重阈值wth=0.01,距离门限L=5,概率阈值Pth=0.1,目标起始过程中的量测信息录取率Plow=0.9.传感器个数为3,且3个传感器类型保持一致,杂波数目服从泊松分布,均值分别为10、15和20,杂波在空间中服从均匀分布,虚警概率PFAτ=0.1,幅度检测门限τ=2.146,目标个数为5,各目标初始运动状态见表 1.
令背景杂波信噪比保持归一化即SNRc=1 dB,当目标信噪比为SNRt1=10 dB即dt1=10时,通过随机数产生500个幅度信息样本,依据极大似然估计得到目标初始信噪比
不同信噪比下的检测概率见表 2,可以发现当目标信噪比已知时,信噪比值越高,对应的检测概率越大,且在[5 dB, 15 dB]和[10 dB, 20 dB]区间内截断正态分布信噪比模型下的检测概率能够保持一个较高的值.
为避免目标的机动对算法产生干扰采用常速度模型,离散形式的状态转移方程和观测方程分别为:
$ {\mathit{\boldsymbol{x}}_n} = \mathit{\boldsymbol{F}}{\mathit{\boldsymbol{x}}_{n - 1}} + \mathit{\boldsymbol{G}}{\mathit{\boldsymbol{w}}_{n - 1}}, $ |
$ {{\mathord{\buildrel{\lower3pt\hbox{$\scriptscriptstyle\frown$}} \over z} }_n} = \mathit{\boldsymbol{H}}{\mathit{\boldsymbol{x}}_n} + {\mathit{\boldsymbol{u}}_n}. $ |
式中:状态转移矩阵
依据极大似然估计得到的目标初始信噪比
在不同信噪比下采用GMBP-AC算法得到的目标跟踪轨迹如图 4所示,可以看出在三维密集杂波环境中可以得到较为准确的目标航迹,且在邻近目标交汇处基本不会发生误跟、失跟等情况.
为避免积分环节对算法运行时间的影响,采用蒙特卡洛方法进行积分计算.由图 5可知,当杂波密度较小时,各算法的运行时间相差不大,此时杂波对算法的干扰作用较小.随着杂波密度的增大,由于多次的迭代信度传播过程和大量的杂波干扰,GMBP算法的计算复杂度较大,且运行时间大于GMPHD算法,引入幅度信息后的GMBP-AK和GMBP-AC算法的运行时间明显缩短,均得到不同幅度的下降,能够较理想地应用在实际情况中.
为了反映估计目标个数随时间的渐变情况,在仿真实验中对式(4)将不进行取整操作.由图 6可知,在相同杂波密度和相同信噪比情况下,各算法均能以相对较短的时间完成对前3个目标的数目估计,但GMPHD的估计误差大.当第4个目标出现时,GMPHD算法的估计误差消除,而GMBP和GMBP-AK算法的估计时间均较长,估计误差增大.当第5个目标出现时,GMPHD、GMBP和GMBP-AK算法的估计性能变差,而本文所提GMBP-AC算法在各时间段内均能够较准确地估计目标数目.
在不同杂波密度相同信噪比情况下,当杂波密度较小时,各算法的估计性能较理想.随着杂波密度的增大,在跟踪前期GMPHD算法的估计误差逐渐大于GMBP算法,且GMPHD算法对目标数目的估计曲线上、下波动幅度大,估计不稳定.与GMBP算法相比,GMBP-AK算法对目标数目的估计性能改善情况不明显,而本文所提的GMBP-AC算法能够在各时间段内快速响应目标数目的变化,对目标数目估计误差平均减小65%左右.在相同杂波密度不同信噪比情况下,当信噪比较高时,各算法的估计性能相对变高,即在高信噪比情况下更有利于算法对目标数目的估计.
4.2.4 跟踪精度为了对比各算法的跟踪精度,采用最优次模式分配(optimal subpattern assignment,OSPA)距离作为评价指标[15](取1阶距,误差调节因子c=15).由图 7可知,在相同杂波密度和相同信噪比情况下,在跟踪前期GMPHD的跟踪精度不如GMBP算法,由于幅度似然比的作用,与GMBP算法相比GMBP-AK和GMBP-AC算法的跟踪精度均得到提高,且这两种算法的跟踪精度基本保持一致,说明本文所提的截断正态分布目标信噪比模型能够较好地应用在目标信噪比未知的情况中.在跟踪后期与GMPHD算法相比,GMBP和GMBP-AK算法的跟踪精度变差,说明受目标起始过程的影响较大,本文所提GMBP-AC算法添加了以幅度信息为条件的目标起始过程,较好地剔除剩余杂波干扰,能够保持较高的跟踪精度.
在不同杂波密度相同信噪比情况下,低杂波密度干扰下各算法的平均OSPA距离相差不大,跟踪精度较理想.随着杂波密度的增大,GMPHD与GMBP算法的跟踪性能均下降,而与GMBP算法相比,GMBP-AK算法的跟踪精度平均提升8%左右,GMBP-AC算法平均提升25%左右,较好地弥补了GMBP-AK算法跟踪精度不高的问题.在相同杂波密度不同信噪比情况下,当信噪比较高时,各算法的OSPA距离相对较小,即在高信噪比情况下更有利于算法跟踪精度的提高.
5 结论1) 本文基于瑞利分布幅度模型和极大似然估计法,依据先验信息构造截断正态分布信噪比模型,通过边缘化得到不以目标信噪比为参数的检测概率和有效幅度概率密度函数.
2) 提出了基于幅度杂波抑制的高斯混合信度传播多目标跟踪算法,将幅度似然比引入信度传播的量测信息函数中,提高目标与量测的关联正确率,同时设置量测信息录取率,提高目标起始效率.
3) 仿真结果表明,在不同杂波密度和信噪比情况下,相比于标准GMPHD和GMBP算法,GMBP-AK和GMBP-AC算法的目标数目估计性能和跟踪精度均得到了提高,其中本文所提GMBP-AC算法的杂波抑制效果更强.
[1] |
PEARL J. Reverend Bayes on inference engines: A distributed hierarchical approach[C]//Proceedings of the 2nd AAAI Conference on Artificial Intelligence. Pittsburgh, Pennsylvania: AAAI Press, 1982: 133
|
[2] |
WILLIAMS J, LAU R. Approximate evaluation of marginal association probabilities with belief propagation[J]. IEEE Transactions on Aerospace and Electronic Systems, 2014, 50(4): 2942. DOI:10.1109/TAES.2014.120568 |
[3] |
MEYER F, BRACA P, WILLETT P, et al. Tracking an unknown number of targets using multiple sensors: A belief propagation method[C]//Proceedings of the 19th International Conference on Information Fusion. Heidelberg, Germany: IEEE, 2016: 719
|
[4] |
MEYER F, BRACA P, WILLETT P, et al. A scalable algorithm for tracking an unknown number of targets using multiple sensors[J]. IEEE Transactions on Signal Processing, 2017, 65(13): 3478. DOI:10.1109/TSP.2017.2688966 |
[5] |
罗兴旺, 张伯彦, 刘嘉, 等. 雷达数据处理中的杂波抑制方法[J]. 系统工程与电子技术, 2016, 38(1): 37. LUO Xingwang, ZHANG Boyan, LIU Jia, et al. Researches on the method of clutter suppression in radar data processing[J]. Systems Engineering and Electronics, 2016, 38(1): 37. DOI:10.3969/j.issn.1001-506X.2016.01.07 |
[6] |
LERRO D, BAR-SHALOM Y. Automated tracking with target amplitude information[C]//Proceedings of American Control Conference for the 90'. San Diego, CA, USA: IEEE, 1990(27): 2875. DOI: 10.1109/OCEANS.1991.606506
|
[7] |
BREKKE E F, HALLINGSTAD O, GLATTERTRE J. Tracking small targets in heavy-tailed clutter using amplitude information[J]. IEEE Journal of Oceanic Engineering, 2010, 35(2): 314. DOI:10.1109/joe.2010.2044670 |
[8] |
李为, 李一平, 封锡盛. 基于幅值信息的改进集成概率数据关联算法[J]. 机器人, 2015, 37(5): 513. LI Wei, LI Yiping, FENG Xisheng, et al. Improved integrated probabilistic data association algorithm based on amplitude information[J]. Robot, 2015, 37(5): 513. DOI:10.13973/j.cnki.robot.2015.0513 |
[9] |
张存, 郑世友, 缪礼锋, 等. 基于信号幅度的复杂目标新数据互联方法[J]. 雷达科学与技术, 2016, 14(4): 411. ZHANG Cun, ZHENG Shiyou, MIAO Lifeng, et al. A new method of complex-target data association based on amplitude information[J]. Radar Science and Technology, 2016, 14(4): 411. DOI:10.3969/j.issn.1672-2337.2016.04.012 |
[10] |
VAN KEUK G. Multihypothesis tracking using incoherent signal-strength information[J]. IEEE Transactions on Aerospace and Electronic Systems, 1996, 32(3): 1164. DOI:10.1109/7.532278 |
[11] |
YANG Feng, ZHANG Wanying, LIANG Yan, et al. Cardinality Balanced Multi-Target Multi-Bernoulli filter for target tracking with amplitude information[C]//Proceedings of the 19th International Conference on Information Fusion. Heidelberg, Germany: IEEE, 2016: 958
|
[12] |
LI Suqi, KONG Lingjiang, YI Wei, et al. PHD filter with amplitude information in weibull clutter[C]//Proceedings of 2013 Radar Conference. Ottawa, ON, Canada: IEEE, 2013: 1. DOI: 10.1109/RADAR.2013.6586050
|
[13] |
BAE S H, KIM Y H, LEE S J, et al. Algorithm for unknown SNR estimation based on sequential Monte Carlo method in cluttered environment[C]//Proceedings of International Conference on Control Automation and Systems. Gyeonggi-do, South Korea: IEEE, 2010: 1004. DOI: 10.1109/ICCAS.2010.5669647
|
[14] |
BAE S H, PARK J, YOON K J. Joint estimation of multi-target signal-to-noise ratio and dynamic states in cluttered environment[J]. IET Radar Sonar and Navigation, 2017, 11(3): 539. DOI:10.1049/iet-rsn.2016.0416 |
[15] |
SCHUHMACHER D, VO B T, VO B N. A consistent metric for performance evaluation of multi-object filters[J]. IEEE Transactions on Signal Processing, 2008, 56(8): 3447. DOI:10.1109/tsp.008.920469 |