CN104778358A - 多传感器存在监测区域部分重叠的扩展目标跟踪方法 - Google Patents
多传感器存在监测区域部分重叠的扩展目标跟踪方法 Download PDFInfo
- Publication number
- CN104778358A CN104778358A CN201510166517.2A CN201510166517A CN104778358A CN 104778358 A CN104778358 A CN 104778358A CN 201510166517 A CN201510166517 A CN 201510166517A CN 104778358 A CN104778358 A CN 104778358A
- Authority
- CN
- China
- Prior art keywords
- target
- sensor
- moment
- measurement
- probability
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Landscapes
- Medicines Containing Antibodies Or Antigens For Use As Internal Diagnostic Agents (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明公开的多传感器存在监测区域部分重叠的扩展目标跟踪方法,对当前量测集进行滤波时使用的高斯分量为当前时刻预测的高斯分量,而非任一传感器量测更新后的高斯分量,使得各个传感器滤波更新后的结果相互独立;当各个传感器量测均参与滤波更新后,对所有传感器的结果高斯项进行判断:若该传感器估计的高斯项中表示目标位置的分量落在重叠区域,则将其权值进行求平均值优化处理;最后,将所有传感器估计出的高斯项的权值、均值以及协方差合并为一个高斯分量作为下一时刻的预测高斯分量。本发明多传感器存在监测区域部分重叠的扩展目标跟踪方法消除了重叠区域带来的目标数目过估计问题以及为未重叠区域带来的量测信息严重丢失问题。
Description
技术领域
本发明属于目标跟踪与目标定位方法技术领域,涉及一种多传感器环境下的目标跟踪方法,具体涉及一种多传感器存在监测区域部分重叠的扩展目标跟踪方法。
背景技术
随着现代传感器精度的不断提高,传感器在监测单个目标时不仅仅只接收到一个量测,更多的时候是一个目标产生的多个量测都能够被监测到,这种能够产生多于一个量测信息的目标被称为一个扩展目标。
在多传感器条件下的扩展目标跟踪算法旨在选择合适的算法把各个传感器接收到的量测信息进行融合,融合后的信息经过滤波处理后,能更精确的反映群目标的真实状态。在融合过程中,可充分利用多个传感器资源,通过对这些传感器及其观测信息的合理支配和使用,把多个传感器在空间或时间上的冗余或互补信息依据某种准则进行组合,以获得被测对象的一致性解释或描述。信息融合的基本目的是通过利用多个传感器共同或联合操作的优势,提高传感器***的有效性和可靠性。
多传感器跟踪***与传统的单传感器跟踪***相比,因其扩大了时空的覆盖范围、改进了测量性能并增加了***的稳定性,使其在军事及一些非军事目标的跟踪中有着非常广泛的应用。
多传感器多目标跟踪就是由多个同类型或者不同类型的传感器在杂波、数据关联不确定、检测概率小于1以及噪声环境下得到无序、数据格式不统一的量测集,通过整合量测集信息,对每一时刻的目标数目和状态进行估计。多传感器扩展目标跟踪算法的基本思想就是通过采取不同的数据融合算法融合多传感器量测,从而达到对目标进行有效跟踪的目的。
常见的数据融合方法主要有:序贯融合算法和并行融合算法,它们被多次使用到目标跟踪领域中。如:Pham等人在文章“Pham N T,Huang W,Ong S H.Multiple sensor multiple object tracking with GMPHD filter[C].InProceedings of the 10th International Conference on Information Fusion.Montreal Quebec Canada:9-12,July,2007:1-7.”中将序贯数据融合算法与高斯扩展概率假设密度滤波(Extend Target-GM-PHD,ET-GM-PHD)算法相结合,实现了在多传感器环境下使用GM-PHD滤波算法对目标进行跟踪。Weifeng等人在文献“Weifeng Liu,Chenglin Wen.The fast linear multisensorRFS-multitarget tracking filters[C].In Proceedings of the 17th InternationalConference on Information Fusion.Salamanca,2014:1-8.”中通过使用量测尺寸扩展的方法,提出了一种运用于线性多传感器环境下的基于随机有限集的多目标跟踪滤波器,并且还为该滤波器提供了一种更快速的量测更新计算方法。上述公开的多传感器融合算法可以直接应用到扩展目标跟踪过程中,然而,现有的多传感器融合算法均假设传感器监测区域不重叠,也就是说,每个传感器均有属于自己独立的一个监测区域,互不干扰。在实际的多传感器环境下,传感器的监测区域往往出现情况不一的部分重叠的情况。
针对多传感器监测区域部分重叠的扩展目标跟踪问题,将传统的序贯滤波算法进行改进后应用到扩展目标跟踪中,得到一种新的扩展目标融合算法,取得了较好的效果。
发明内容
本发明的目的在于提供一种多传感器存在监测区域部分重叠的扩展目标跟踪方法,合理利用多个传感器接收到的量测信息,基于多传感器环境下的融合算法估计出每一时刻的扩展目标的状态,提高了跟踪精度。
本发明所采用的技术方案是,多传感器存在监测区域部分重叠的扩展目标跟踪方法,具体按照以下步骤实施:
步骤1、采用一个随机集表示k时刻扩展目标的状态;
k时刻扩展目标的状态包括有如下信息:目标质心的位置、速度以及加速度;
在随机集 中:
表示在k时刻第i个扩展目标的状态,Nx,k表示k时刻的目标数目;
预先设定第i个扩展目标状态向量为其动态方程具体如下:
在动态方程中:
Fk为目标的动态转移矩阵,将Fk作为线性高斯模型,采用卡尔曼滤波算法对目标进行跟踪;
为协方差为的过程噪声;
每个目标的动态转移方程采用的是同一个模型并且它们之间是相互独立的;
扩展目标单个传感器的量测集为量测集是由传感器观测k时刻的真实目标的运动状态产生的数据信息集合,对于第i个扩展目标的状态产生的量测信息按如下算法实施:
式中,Hk表示目标量测矩阵,表示高斯白噪声且它的协方差为Rk;
在k时刻,第i个扩展目标产生的量测个数服从泊松分布;
即:
表示相应扩展目标所产生量测个数的均值,在k时刻该扩展目标至少产生一个量测的概率,其概率值为:
为一个已知的定义在目标的状态空间上的一个非负函数,则该扩展目标的检测概率为:
其中,为第i个扩展目标能够被检测到的概率,为目标未被检测到的概率;
在观测目标状态的同时,能观测到杂波信息,每一时刻杂波的数目服从一个随机变量为βFA,k的泊松分布,此处的随机变量βFA,k为在扩展目标跟踪中的杂波率,则在k时刻,单个传感器的扩展目标量测集Zk具体模型如下:
在上述模型中,Zc,k为k时刻的杂波集;
在多个传感器共同形成的环境下,当前传感器的总数量为L个,在k时刻,L个传感器接收到的量测集合为:
其中,为第m个传感器接收到的量测信息;
步骤2、经步骤1得到L个传感器的量测集合后,利用动态方程对扩展目标位置进行估计;
步骤3、经步骤2完成对扩展目标位置估计后,将得到的当前时刻目标总的权值、均值以及协方差进行保存;返回步骤2.2,在下一时刻作为步骤2.2中的所需的目标初始权值、均值以及协方差,经多次循环后最终实现多传感器存在监测区域部分重叠的扩展目标跟踪;
步骤2.2~步骤3为循环过程,循环至目标结束移动后结束,设定目标移动周期为100s。
本发明的特点还在于:
步骤2具体按照以下步骤实施:
步骤2.1、在扩展目标的初始位置,即k=0时刻,经计算得到扩展多目标的初始概率假设密度;
初始概率假设密度具体按照以下算法实施:
在初始概率假设密度计算式中,Jk为初始目标的高斯项的个数,为初始目标的第j个高斯项的权值,为初始目标的第j个高斯项的均值,为初始目标的第j个高斯项的协方差;
步骤2.2、经步骤2.1计算得到初始概率假设密度后,根据k-1采样时刻的概率假设密度,预测出k时刻的概率假设密度;
步骤2.3、对经步骤1得到的L个传感器的量测集合进行划分,得到划分后传感器的观测值,具体划分方法如下:
在k时刻,多个扩展目标能够产生多个量测集,通过设定阈值来对空间内的L个传感器的量测集合进行划分,具体划分规则如下:
用于划分量测集合的阈值大小取决于量测噪声与自由度n在距离概率处的逆累积分布函数值的乘积,此处设置自由度n=2时,效果最佳;将距离小于阈值的量测集合归为一个集合,并将该集合作为其中一个扩展目标产生的量测信息,最终获得划分后传感器的观测值;
步骤2.4、根据步骤2.2预测得到的k时刻的概率假设密度,对经步骤2.3划分后传感器的观测值进行量测更新;
步骤2.5、将步骤2.4处理后,对所得到的所有量测更新后的权值、均值以及协方差进行判断及合并;
步骤2.6、经步骤2.5处理后,继续进行修剪与合并,修剪与合并具体按照以下方法实施:
根据时间的推移以及目标的出现,高斯项数目会迅速增加,通过裁剪权值低于修剪门限的高斯项以达到减少高斯项个数的目的,修剪门限值设置为0.00005时效果最佳;
将距离小于合并门限的高斯项合并到一起,合并门限值设置为4时效果最佳。
步骤2.2具体按照以下步骤实施:
步骤2.2.1、在k时刻,分别预测新目标集的概率假设密度、衍生目标集的概率假设密度、幸存目标集的概率假设密度;
步骤2.2.2、经步骤2.2.1预测得到新生目标集、衍生目标集以及幸存目标集后,再预测出基于概率假设密度的高斯分布的总个数,具体按照以下算的实施:
Jk|k-1=Jγ+Jβ+Jk-1|k-1;
式中,Jγ为新生目标的高斯项个数;Jβ为衍生目标的高斯项个数;Jk-1|k-1为幸存目标的高斯项个数;
步骤2.2.3、根据步骤2.2.1和步骤2.2.2的结果,预测出k时刻的概率假设密度,具体预测模型如下:
步骤2.2.1具体按照以下方法实施:
预测在k时刻时,
新目标集的概率假设密度,具体如下:
预测衍生目标集在k时刻的概率假设密度,具体如下:
预测幸存目标集在k时刻时的概率假设密度,具体如下:
其中,PS,k表示的是目标幸存概率;代表新生目标、衍生目标以及幸存目标的分量分别用下标γ、β和S来表示,w、m以及P下标出现的k|k-1表示为k-1时刻到k时刻的一步预测对应的高斯项的权重、均值以及协方差。
步骤2.4具体按照如下步骤实施:
步骤2.4.1、更新k时刻时的概率假设密度,具体按照如下算法实施:
式中,用于计算未检测到目标的情况;
步骤2.4.2、若当前传感器接收到的量测信息为空时,用于计算检测到目标的情况,对建模,得到如下高斯形式:
式中:
对模型中的变量建模,得到如下高斯形式:
式中:
以上的所有未知参数由如下算法得到:
其中,zk为在元胞W中的所有量测值,δ|W|,1为克罗内克符号,I为单位矩阵,为增益矩阵,λk为杂波个数,ck为杂波密度,λkck表示为杂波的概率假设密度; 符号代表垂直方向上的矢量连接;
步骤2.4.3、分别采用L个传感器,即传感器1、传感器2、传感器3…、传感器L对经步骤2.4.2接收到的量测进行更新,具体按照如下方法实施:
先采用传感器1对接受到的量测进行更新,具体按照如下算法进行更新:
式中,W1为对划分后的元胞,通过计算得到更新后的权值、均值以及协方差,分别令权值为均值为和协方差为
接着采用传感器2对接受到的量测进行更新,具体按照如下算法进行更新:
式中,W2为对划分后的元胞,通过计算得到更新后权值,均值以及协方差,分别令权值为均值为和协方差为
再采用传感器3~传感器L依次进行量测更新,通过计算获得更新后相对应的权值、均值以及协方差。
步骤2.5具体按照如下方法实施:
若第m个传感器的权值的第一维分量a<ξ1<b且第二维分量c<ξ2<d;
其中,a,b的取值范围依赖于重叠区域的x轴位置;c,d的取值范围依赖于重叠区域的y轴位置,
则对应的
待所有的高斯分量都进行优化处理完后,得到最终的更新结果,最终更新结果具体如下:
本发明的有益效果是:
(1)本发明多传感器存在监测区域部分重叠的扩展目标跟踪方法能消除以下两种情况对目标跟踪精度造成的影响:一种是存在监测区域部分重叠情况下的多传感器接收到的量测值信息部分重叠的情况;另一种是传感器存在非重叠区域导致的量测值信息不全的情况。
(2)本发明多传感器存在监测区域部分重叠的扩展目标跟踪方法允许传感器存在监测区域重叠的情况,在该情况下能够对扩展目标进行有效的跟踪。
(3)本发明多传感器存在监测区域部分重叠的扩展目标跟踪方法实现了对多传感器存在监测区域部分重叠环境下的扩展目标进行连续的定位。
附图说明
图1是监视区域部分重叠的多传感器扩展目标的目标轨迹及传感器观测区域图;
图2是改进后的序贯融合扩展GM-PHD滤波估计出的目标轨迹;
图3是使用并行融合扩展GM-PHD滤波算法估计出的目标轨迹;
图4是依次采用传感器1和传感器2量测信息的序贯融合扩展GM-PHD滤波算法估计出的目标轨迹;
图5是依次采用传感器2和传感器1量测信息的序贯融合扩展GM-PHD滤波算法估计出的目标轨迹;
图6是本发明多传感器存在监测区域部分重叠的扩展目标跟踪方法与现有的多传感器环境下的目标跟踪方法估计出的目标数目对比图;
图7是本发明多传感器存在监测区域部分重叠的扩展目标跟踪方法与现有的多传感器环境下的目标跟踪方法估计出的目标状态与真实目标状态的最优子模式指派(Optimal Sub-pattern Assignment,OSPA)距离对比图。
具体实施方式
下面结合附图和具体实施方式对本发明进行详细说明。
本发明多传感器存在监测区域部分重叠的扩展目标跟踪方法,具体按照以下步骤实施:
步骤1、在基于扩展目标的跟踪问题中,在通常情况下,采用一个随机集来表示k时刻扩展目标的状态,k时刻扩展目标的状态包括的信息有:目标质心的位置、速度以及加速度;
在随机集中,表示在k时刻第i个扩展目标的状态,Nx,k表示k时刻的目标数目;
预先设定第i个扩展目标状态向量为其动态方程具体如下:
在式(1)中,Fk为目标的动态转移矩阵;
当Fk为高斯线性模型时,采用普通的卡尔曼滤波算法对目标进行跟踪;当Fk为非线性模型时,采用扩展卡尔曼滤波算法思想对目标进行跟踪;
在本发明多传感器存在监测区域部分重叠的扩展目标跟踪方法方法中,Fk为线性高斯模型;为协方差为的过程噪声;每个目标的动态转移方程采用的都是同一个模型并且它们之间是相互独立的。
扩展目标单个传感器的量测集为:该量测集是由传感器观测k时刻的真实目标的运动状态而产生的数据信息集合,对第i个扩展目标的状态产生的量测信息进行建模处理,其模型具体如下:
在式(2)中,Hk表示目标量测矩阵;表示高斯白噪声,它的协方差为Rk;
在k时刻,第i个扩展目标产生的量测个数服从泊松分布,即:满足如下关系:
其中,表示相应扩展目标所产生量测个数的均值;在k时刻该扩展目标至少产生一个量测的概率,其概率值为:
在式(3)中,为一个已知的定义在目标的状态空间上的一个非负函数,该扩展目标的检测概率为:
在式(4)中,为第i个扩展目标能够被检测到的概率,为目标未被检测到的概率。
在观测目标状态的同时也能观测到一些杂波信息,经分析每一时刻杂波的数目服从一个随机变量为βFA,k的泊松分布,此处的随机变量βFA,k也就是在扩展目标跟踪中常说的杂波率;因此,k时刻的单个传感器的扩展目标量测集Zk具体如下:
式(5)中,Zc,k表示的是k时刻的杂波集。
在多个传感器共同形成的环境下,当前传感器的总个数为L,在k时刻,L个传感器接收到的量测集合为:
式(6)中,表示的是第m个传感器接收到的量测信息。
在实际应用中,若使用多个传感器存在监测区域重叠现象,对于某一个传感器来讲,其监测区域可以分为重叠区域和非重叠区域;若采用传统序贯融合,在非重叠区域的目标会大量丢失;若采用传统并行融合,则在重叠区域估计到的目标数目会大大超出实际数目。
上述的两种融合算法都将会对目标的跟踪精度造成巨大的影响。
步骤2、经步骤1得到L个传感器的量测集合后,利用动态方程对扩展目标位置进行估计,具体按照如下步骤实施:
步骤2.1、在扩展目标的初始位置,即k=0时刻,经计算得到扩展多目标的初始概率假设密度;
初始概率假设密度具体按照以下算法实施:
式(7)中,Jk为初始目标的高斯项的个数,为初始目标的第j个高斯项的权值,为初始目标的第j个高斯项的均值,为初始目标的第j个高斯项的协方差;
步骤2.2、经步骤2.1计算得到初始概率假设密度后,根据k-1采样时刻的概率假设密度,预测出k时刻的概率假设密度,具体按照如下方法实施:
步骤2.2.1、分别预测在k时刻时,新目标集的概率假设密度、衍生目标集的概率假设密度、幸存目标集的概率假设密度,它们分别可表示为如下高斯形式:
预测在k时刻时新目标集的概率假设密度,具体算法如下:
预测衍生目标集在k时刻的概率假设密度,具体算法如下:
预测幸存目标集在k时刻时的概率假设密度,具体算法如下:
其中,PS,k表示的是目标幸存概率,新生目标、衍生目标以及幸存目标的分量分别用下标γ、β和S来表示,w、m以及P下标出现的k|k-1表示k-1时刻到k时刻的一步预测对应的高斯项的权重、均值以及协方差;
步骤2.2.2、经步骤2.2.1预测得到新生目标集、衍生目标集以及幸存目标集后,再预测出基于概率假设密度的高斯分布的总个数,具体按照以下算的实施:
Jk|k-1=Jγ+Jβ+Jk-1|k-1;
其中,Jγ为新生目标的高斯项个数;Jβ为衍生目标的高斯项个数;Jk-1|k-1为幸存目标的高斯项个数;
步骤2.2.3、根据步骤2.2.1和步骤2.2.2的结果,经计算预测出k时刻的概率假设密度,具体计算模型如下:
步骤2.3、对经步骤1得到的L个传感器的量测集合进行划分,得到划分后传感器的观测值,具体划分方法如下:
在k时刻时,多个扩展目标能够产生多个量测集,通过设定阈值来对空间内的量测集合进行划分,具体划分规则为:设定的这个阈值的确定取决于量测噪声与自由度n在距离概率处的逆累积分布函数值的乘积,经多次试验发现此处设置为n=2时,效果最佳;将距离小于阈值的量测集合归为一起集合作为其中一个扩展目标产生的量测信息,获得划分后传感器的观测值;
步骤2.4、根据步骤2.2预测得到的k时刻的概率假设密度,对经步骤2.3划分后传感器的观测值进行量测更新,具体按照如下步骤实施:
步骤2.4.1、更新k时刻时的概率假设密度,具体按照如下算法实施:
在式(9)中,用于计算未检测到目标的情况;
步骤2.4.2、若当前传感器接收到的量测信息为空时,用于计算检测到目标的情况;
对建模,得到如下高斯形式:
在式(10)中:
对式(9)中的变量建模,得到如下高斯形式:
在式(14)中:
以上的所有未知参数可由如下算法得到:
其中,zk为在元胞W中的所有量测值,δ|W|,1为克罗内克符号,I为单位矩阵,为增益矩阵,λk为杂波个数,ck为杂波密度,λkck表示为杂波的概率假设密度; 符号代表垂直方向上的矢量连接;
步骤2.4.3、分别采用L个传感器,即传感器1、传感器2、传感器3…、传感器L对经步骤2.4.2接收到的量测进行更新,具体按照如下方法实施:
采用传感器1对接受到的量测进行更新,具体按照如下算法进行更新:
其中,W1为对划分后的元胞,通过式(15)~式(23)的计算得到更新后的权值、均值以及协方差,分别令权值为均值为和协方差为
继续采用传感器2对接受到的量测进行更新,具体按照如下算法进行更新:
式(25)中,W2为对划分后的元胞,通过计算得到更新后权值,均值以及协方差,分别令权值为均值为和协方差为
再采用传感器3~传感器L依次进行量测更新,通过计算获得更新后所有量测相对应的权值、均值以及协方差;
步骤2.5、将步骤2.4处理后,对所得到的所有量测更新后的权值、均值以及协方差进行判断及合并;
若第m个传感器的权值的第一维分量a<ξ1<b且第二维分量c<ξ2<d;
其中,a,b的取值范围依赖于重叠区域的x轴位置;c,d的取值范围依赖于重叠区域的y轴位置;
则对应的
待所有的高斯分量都进行优化处理完后,得到最终的更新结果,最终更新结果具体如下:
步骤2.6、经步骤2.5处理后,继续进行修剪与合并,修剪与合并具体按照以下方法实施:
随着时间的推移以及目标的出现,高斯项数目会迅速增加,为了防止高斯项个数过大,通过裁剪权值低于修剪门限的高斯项以达到减少高斯项个数的目的,经多次试验发现此处修剪门限值设置为0.00005时效果最佳;将距离小于合并门限的高斯项合并到一起,经多次试验发现此处合并门限值设置为4时效果最佳;
步骤3、经步骤2完成对扩展目标位置估计后,将得到的当前时刻目标总的权值、均值以及协方差进行保存;返回步骤2.2,在下一时刻作为步骤2.2中的所需的目标初始权值、均值以及协方差,经多次循环后最终实现多传感器存在监测区域部分重叠的扩展目标跟踪;
其中,步骤2.2~步骤3为循环过程,循环至目标结束移动后结束,设定目标移动周期为100s。
通过仿真实验验证本发明多传感器存在监测区域部分重叠的扩展目标跟踪方法的有效性和实用性。
考虑一个扩展/群目标跟踪例子,k时刻的目标状态集其中, 分别表示目标位置和速度分量,其动态方程如下:
在上述动态方程中,Fk为状态转移矩阵;其中,Fk为一个4×4的矩阵;wk为零均值的高斯白噪声,其方差为Qk;
在实验中,目标存活概率ps=0.99;目标检测概率pD=0.99;
此外, 过程噪声协方差
上式中, 采样间隔T=1;
目标强度初始值为:J0=1,w0=0.1,m0=[0,0,0,0]T,P0=diag(0,0,0,0);监控区域为[-1000,1000]×[-1000,1000],仿真实验周期为100s,杂波在整个监控区域服从均匀分布,每一时刻杂波数服从泊松分布,杂波均值设为50;
量测方程具体如下:
在仿真实验中,使用两个传感器,即令L=2;
传感器量测噪声协方差为:
传感器的量测矩阵为
监视区域部分重叠的多传感器扩展/群目标的目标轨迹以及传感器观测区域图如图1所示,从图1中可看出:
传感器1(sensor1)可观测到区域为[-1000,250]×[-1000,1000];
传感器2(sensor2)可观测到的区域为[-250,1000]×[-1000,1000];
中间区域[-250,250]×[-1000,1000]为重叠区域,该区域的量测值可被传感器1与传感器2同时接收到。
分别使用改进后的序贯融合扩展GM-PHD滤波算法、并行融合扩展GM-PHD滤波算法以及传统序贯融合扩展GM-PHD;其中传统序贯融合扩展GM-PHD滤波算法包括了两种方式融合方式,分别为先使用传感器1再使用传感器2进行序贯滤波和先使用传感2量测值再使用传感器1进行序贯滤波,对扩展/群目标进行跟踪。
分别使用不同算法进行滤波后运行结果如图2~图6所示:
由图2可知:本发明方法中提出的改进后的序贯融合扩展GM-PHD滤波算法无论在重叠的监视区域还是未重叠的监视区域均能够对目标进行有效的跟踪,所估计出的目标位置与真实目标位置基本一致。
由图3可知:使用并行融合扩展GM-PHD滤波算法在对目标进行跟踪时,在监视重叠区域[-250,250]×[-1000,1000]中,在使用与改进后的新方法使用相同的初始权值,以及相同的修剪阈值时会出现明显的目标过估计的情况。
由图4和图5可知:在使用传统的序贯融合扩展GM-PHD滤波算法中,先使用传感器1再使用传感器2的序贯方式中,会出现传感器1未监视的区域无法跟踪目标状态的现象,先使用传感器2再使用传感器1的序贯方式中,则会出现传感器2未监视的区域无法跟踪目标的现象。因此,使用传统序贯扩展GM-PHD滤波算法跟踪目标的过程中,无论采用哪种序贯方式,均会出现目标明显的漏估计的现象。由于从第1至第64时刻相对应的为算法跟踪目标的重叠区域所用的时间区间,从1至64秒真实目标数为2,64至100秒真实目标数为4。
由图6可知:使用并行融合滤波算法出现了明显的过估计情况,而在65时刻到100时刻后,并行融合滤波算法估计目标数目的正确率增加;传感器2观测的区域为[-250,250]×[-1000,1000],几乎包含了全部重叠区域。所以从第时刻1至第64时刻先使用传感器1再使用传感器2的方式序贯融合滤波算法在目标数目估计上也有着较高的准确率,在65时刻至100时刻[-250,-1000]×[-1000,1000]区域内的目标无法跟踪,所以出现了严重的目标数目漏估计现象;[-250,1000]×[-1000,1000]区域包含了重叠区域,也包含了未重叠区域,该区域传感器1无法观测到,所以先使用传感器2再使用传感器1的方式序贯融合滤波在整个100时刻内,均会出现明显的目标数目漏估计的现象。而本文算法无论是在重叠区域还是非重叠区域能够较为正确地估计出目标数目。
为了衡量各种算法的跟踪误差,图7给出了四种算法的OSPA(OptimalSub-pattern Assignment,OSPA)距离,由于目标从时刻1到时刻64,由于并行滤波的过估计,从而使得OSPA距离偏高,而在时刻64至时刻100后能较为精确的追踪,所以OSPA距离减小。先使用传感器2再使用传感器1的序贯融合滤波算法在整个时间段内均有漏估计现象,所以OSPA距离整体也偏高。先使用传感器1再使用传感器2序贯融合滤波算法从时刻65至时刻100的OSPA距离较大。从整体上看,新算法的OSPA距离从时刻1至时刻100较稳定,均处于一个较低的水平。
本发明多传感器存在监测区域部分重叠的扩展目标跟踪方法对当前量测集进行滤波时使用的高斯分量为当前时刻预测的高斯分量,而非任一传感器量测更新后的高斯分量,使得各个传感器滤波更新后的结果相互独立;当各个传感器量测均参与滤波更新后,对所有传感器的结果高斯项进行判断:若该传感器估计的高斯项中表示目标位置的分量落在重叠区域,则将其权值进行求平均值优化处理;最后,将所有传感器估计出的高斯项的权值、均值以及协方差合并为一个高斯分量作为下一时刻的预测高斯分量。通过上述算法达到优化并融合多个传感器量测信息的目的。
本发明多传感器存在监测区域部分重叠的扩展目标跟踪方法消除了重叠区域带来的目标数目过估计问题以及为未重叠区域带来的量测信息严重丢失问题。本发明多传感器存在监测区域部分重叠的扩展目标跟踪方法无需假设传感器监测区域独立,无论传感器监测区域重叠与否,均能够有效地优化并融合多个传感器量测信息且较为精确地跟踪扩展目标。
Claims (6)
1.多传感器存在监测区域部分重叠的扩展目标跟踪方法,其特征在于,具体按照以下步骤实施:
步骤1、采用一个随机集表示k时刻扩展目标的状态;
k时刻扩展目标的状态包括有如下信息:目标质心的位置、速度以及加速度;
在随机集 中:
表示在k时刻第i个扩展目标的状态,Nx,k表示k时刻的目标数目;
预先设定第i个扩展目标状态向量为其动态方程具体如下:
在动态方程中:
Fk为目标的动态转移矩阵,将Fk作为线性高斯模型,采用卡尔曼滤波算法对目标进行跟踪;
为协方差为的过程噪声;
每个目标的动态转移方程采用的是同一个模型并且它们之间是相互独立的;
扩展目标单个传感器的量测集为量测集是由传感器观测k时刻的真实目标的运动状态产生的数据信息集合,对于第i个扩展目标的状态产生的量测信息按如下算法实施:
式中,Hk表示目标量测矩阵,表示高斯白噪声且它的协方差为Rk;
在k时刻,第i个扩展目标产生的量测个数服从泊松分布;
即:
表示相应扩展目标所产生量测个数的均值,在k时刻该扩展目标至少产生一个量测的概率,其概率值为:
为一个已知的定义在目标的状态空间上的一个非负函数,则该扩展目标的检测概率为:
其中,为第i个扩展目标能够被检测到的概率,为目标未被检测到的概率;
在观测目标状态的同时,能观测到杂波信息,每一时刻杂波的数目服从一个随机变量为βFA,k的泊松分布,此处的随机变量βFA,k为在扩展目标跟踪中的杂波率,则在k时刻,单个传感器的扩展目标量测集Zk具体模型如下:
在上述模型中,Zc,k为k时刻的杂波集;
在多个传感器共同形成的环境下,当前传感器的总个数为L,在k时刻,L个传感器接收到的量测集合为:
其中,为第m个传感器接收到的量测信息;
步骤2、经步骤1得到L个传感器的量测集合后,利用动态方程对扩展目标位置进行估计;
步骤3、经步骤2完成对扩展目标位置估计后,将得到的当前时刻目标总的权值、均值以及协方差进行保存;返回步骤2.2,在下一时刻作为步骤2.2中的所需的目标初始权值、均值以及协方差,经多次循环后最终实现多传感器存在监测区域部分重叠的扩展目标跟踪;
步骤2.2~步骤3为循环过程,循环至目标结束移动后结束,设定目标移动周期为100s。
2.根据权利要求1所述的多传感器存在监测区域部分重叠的扩展目标跟踪方法,其特征在于,所述步骤2具体按照以下步骤实施:
步骤2.1、在扩展目标的初始位置,即k=0时刻,经计算得到扩展多目标的初始概率假设密度;
初始概率假设密度具体按照以下算法实施:
在初始概率假设密度计算式中,Jk为初始目标的高斯项的个数,为初始目标的第j个高斯项的权值,为初始目标的第j个高斯项的均值,为初始目标的第j个高斯项的协方差;
步骤2.2、经步骤2.1计算得到初始概率假设密度后,根据k-1采样时刻的概率假设密度,预测出k时刻的概率假设密度;
步骤2.3、对经步骤1得到的L个传感器的量测集合进行划分,得到划分后传感器的观测值,具体划分方法如下:
在k时刻,多个扩展目标能够产生多个量测集,通过设定阈值来对空间内的L个传感器的量测集合进行划分,具体划分规则如下:
用于划分量测集合的阈值大小取决于量测噪声与自由度n在距离概率处的逆累积分布函数值的乘积,此处设置自由度n=2时,效果最佳;将距离小于阈值的量测集合归为一个集合,并将该集合作为其中一个扩展目标产生的量测信息,最终获得划分后传感器的观测值;
步骤2.4、根据步骤2.2预测得到的k时刻的概率假设密度,对经步骤2.3划分后传感器的观测值进行量测更新;
步骤2.5、将步骤2.4处理后,对所得到的所有量测更新后的权值、均值以及协方差进行判断及合并;
步骤2.6、经步骤2.5处理后,继续进行修剪与合并,修剪与合并具体按照以下方法实施:
根据时间的推移以及目标的出现,高斯项数目会迅速增加,通过裁剪权值低于修剪门限的高斯项以达到减少高斯项个数的目的,修剪门限值设置为0.00005时效果最佳;
将距离小于合并门限的高斯项合并到一起,合并门限值设置为4时效果最佳。
3.根据权利要求2所述的多传感器存在监测区域部分重叠的扩展目标跟踪方法,其特征在于,所述步骤2.2具体按照以下步骤实施:
步骤2.2.1、在k时刻,分别预测新目标集的概率假设密度、衍生目标集的概率假设密度、幸存目标集的概率假设密度;
步骤2.2.2、经步骤2.2.1预测得到新生目标集、衍生目标集以及幸存目标集后,再预测出基于概率假设密度的高斯分布的总个数,具体按照以下算的实施:
Jk|k-1=Jγ+Jβ+Jk-1|k-1;
式中,Jγ为新生目标的高斯项个数;Jβ为衍生目标的高斯项个数;Jk-1|k-1为幸存目标的高斯项个数;
步骤2.2.3、根据步骤2.2.1和步骤2.2.2的结果,预测出k时刻的概率假设密度,具体预测模型如下:
4.根据权利要求3所述的多传感器存在监测区域部分重叠的扩展目标跟踪方法,其特征在于,所述步骤2.2.1具体按照以下方法实施:
预测在k时刻时,
新目标集的概率假设密度,具体如下:
预测衍生目标集在k时刻的概率假设密度,具体如下:
预测幸存目标集在k时刻时的概率假设密度,具体如下:
其中,PS,k表示的是目标幸存概率;代表新生目标、衍生目标以及幸存目标的分量分别用下标γ、β和S来表示,w、m以及P下标出现的k|k-1表示为k-1时刻到k时刻的一步预测对应的高斯项的权重、均值以及协方差。
5.根据权利要求2所述的多传感器存在监测区域部分重叠的扩展目标跟踪方法,其特征在于,所述步骤2.4具体按照如下步骤实施:
步骤2.4.1、更新k时刻时的概率假设密度,具体按照如下算法实施:
式中,用于计算未检测到目标的情况;
步骤2.4.2、若当前传感器接收到的量测信息为空时,用于计算检测到目标的情况,对建模,得到如下高斯形式:
式中:
对模型中的变量建模,得到如下高斯形式:
式中:
以上的所有未知参数由如下算法得到:
其中,zk为在元胞W中的所有量测值,δ|W|,1为克罗内克符号,I为单位矩阵,为增益矩阵,λk为杂波个数,ck为杂波密度,λkck表示为杂波的概率假设密度; 符号代表垂直方向上的矢量连接;
步骤2.4.3、分别采用L个传感器,即传感器1、传感器2、传感器3…、传感器L对经步骤2.4.2接收到的量测进行更新,具体按照如下方法实施:
先采用传感器1对接受到的量测进行更新,具体按照如下算法进行更新:
式中,W1为对划分后的元胞,通过计算得到更新后的权值、均值以及协方差,分别令权值为均值为和协方差为
接着采用传感器2对接受到的量测进行更新,具体按照如下算法进行更新:
式中,W2为对划分后的元胞,通过计算得到更新后权值,均值以及协方差,分别令权值为均值为和协方差为
再采用传感器3~传感器L依次进行量测更新,通过计算获得更新后相对应的权值、均值以及协方差。
6.根据权利要求2所述的多传感器存在监测区域部分重叠的扩展目标跟踪方法,其特征在于,所述步骤2.5具体按照如下方法实施:
若第m个传感器的权值的第一维分量a<ξ1<b且第二维分量c<ξ2<d;
其中,a,b的取值范围依赖于重叠区域的x轴位置;c,d的取值范围依赖于重叠区域的y轴位置,
则对应的
待所有的高斯分量都进行优化处理完后,得到最终的更新结果,最终更新结果具体如下:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510166517.2A CN104778358B (zh) | 2015-04-09 | 2015-04-09 | 多传感器存在监测区域部分重叠的扩展目标跟踪方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510166517.2A CN104778358B (zh) | 2015-04-09 | 2015-04-09 | 多传感器存在监测区域部分重叠的扩展目标跟踪方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104778358A true CN104778358A (zh) | 2015-07-15 |
CN104778358B CN104778358B (zh) | 2017-11-10 |
Family
ID=53619818
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510166517.2A Expired - Fee Related CN104778358B (zh) | 2015-04-09 | 2015-04-09 | 多传感器存在监测区域部分重叠的扩展目标跟踪方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104778358B (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105512721A (zh) * | 2015-11-13 | 2016-04-20 | 浙江工业大学 | 一种多目标元胞差分方法 |
CN106407887A (zh) * | 2016-08-24 | 2017-02-15 | 重庆大学 | 一种候选框搜索步长的获取方法及装置 |
CN107990821A (zh) * | 2017-11-17 | 2018-05-04 | 深圳大学 | 一种桥梁形变监测方法、存储介质及桥梁形变监测接收机 |
CN108333569A (zh) * | 2018-01-19 | 2018-07-27 | 杭州电子科技大学 | 一种基于phd滤波的异步多传感器融合多目标跟踪方法 |
CN108344981A (zh) * | 2018-01-19 | 2018-07-31 | 杭州电子科技大学 | 面向杂波的多传感器异步检测tsbf多目标跟踪方法 |
CN108573271A (zh) * | 2017-12-15 | 2018-09-25 | 蔚来汽车有限公司 | 多传感器目标信息融合的优化方法及装置、计算机设备和记录介质 |
CN108717702A (zh) * | 2018-04-24 | 2018-10-30 | 西安工程大学 | 基于分段rts的概率假设密度滤波平滑方法 |
CN108734725A (zh) * | 2018-04-11 | 2018-11-02 | 杭州电子科技大学 | 基于高斯过程的概率数据关联滤波扩展目标跟踪方法 |
CN109670142A (zh) * | 2019-01-07 | 2019-04-23 | 杭州电子科技大学 | 一种基于随机有限集的可分辨机动群目标状态估计方法 |
CN110395251A (zh) * | 2019-06-27 | 2019-11-01 | 驭势(上海)汽车科技有限公司 | 一种基于多传感器融合数据的自动紧急制动决策方法 |
CN110462546A (zh) * | 2017-03-28 | 2019-11-15 | 日本电产株式会社 | 移动体 |
CN110472086A (zh) * | 2019-08-02 | 2019-11-19 | 西安工程大学 | 一种基于视网膜关键特征提取的骨架图像检索方法 |
CN111340853A (zh) * | 2019-12-04 | 2020-06-26 | 杭州电子科技大学 | 基于ospa迭代的多传感器gmphd自适应融合方法 |
WO2024001629A1 (zh) * | 2022-07-01 | 2024-01-04 | 重庆邮电大学 | 一种面向智能驾驶车辆的多传感器融合方法及*** |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010190869A (ja) * | 2009-02-20 | 2010-09-02 | Mitsubishi Electric Corp | センサ制御装置 |
CN103310115A (zh) * | 2013-06-27 | 2013-09-18 | 西安电子科技大学 | 一种多目标跟踪的杂波估计方法 |
CN103324835A (zh) * | 2013-05-30 | 2013-09-25 | 深圳大学 | 概率假设密度滤波器目标信息的保持方法及信息保持*** |
CN103729637A (zh) * | 2013-12-31 | 2014-04-16 | 西安工程大学 | 基于容积卡尔曼滤波的扩展目标概率假设密度滤波方法 |
CN103869279A (zh) * | 2014-02-27 | 2014-06-18 | 杭州电子科技大学 | 一种多传感器平台的多目标定位跟踪方法 |
-
2015
- 2015-04-09 CN CN201510166517.2A patent/CN104778358B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010190869A (ja) * | 2009-02-20 | 2010-09-02 | Mitsubishi Electric Corp | センサ制御装置 |
CN103324835A (zh) * | 2013-05-30 | 2013-09-25 | 深圳大学 | 概率假设密度滤波器目标信息的保持方法及信息保持*** |
CN103310115A (zh) * | 2013-06-27 | 2013-09-18 | 西安电子科技大学 | 一种多目标跟踪的杂波估计方法 |
CN103729637A (zh) * | 2013-12-31 | 2014-04-16 | 西安工程大学 | 基于容积卡尔曼滤波的扩展目标概率假设密度滤波方法 |
CN103869279A (zh) * | 2014-02-27 | 2014-06-18 | 杭州电子科技大学 | 一种多传感器平台的多目标定位跟踪方法 |
Non-Patent Citations (5)
Title |
---|
LUNDQUIST C,ET AL.: "《Extended target tracking using a Gaussian-mixture PHD filter》", 《IEEE TRANSACTIONS ON AEROSPACE AND ELECTRONIC SYSTEMS》 * |
ORGUNER O,ET AL.: "《Extended target tracking with a cardinalized probability hypothesis density filter》", 《PROCEEDINGS OF THE 14TH INTERNATIONAL CONFERENCE ON INFORMATION FUSION》 * |
何衍,等: "《基于交叉定位的多传感器多机动目标跟踪》", 《***工程与电子技术》 * |
杨峰,等: "《基于概率假设密度滤波方法的多目标跟踪技术综述》", 《自动化学报》 * |
欧阳成: "《基于随机集理论的被动多传感器多目标跟踪》", 《中国博士学位论文全文数据库 信息科技辑 》 * |
Cited By (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105512721B (zh) * | 2015-11-13 | 2018-05-04 | 浙江工业大学 | 一种多目标元胞差分方法 |
CN105512721A (zh) * | 2015-11-13 | 2016-04-20 | 浙江工业大学 | 一种多目标元胞差分方法 |
CN106407887A (zh) * | 2016-08-24 | 2017-02-15 | 重庆大学 | 一种候选框搜索步长的获取方法及装置 |
CN106407887B (zh) * | 2016-08-24 | 2020-07-31 | 重庆大学 | 一种候选框搜索步长的获取方法及装置 |
CN110462546A (zh) * | 2017-03-28 | 2019-11-15 | 日本电产株式会社 | 移动体 |
CN107990821A (zh) * | 2017-11-17 | 2018-05-04 | 深圳大学 | 一种桥梁形变监测方法、存储介质及桥梁形变监测接收机 |
CN107990821B (zh) * | 2017-11-17 | 2019-12-17 | 深圳大学 | 一种桥梁形变监测方法、存储介质及桥梁形变监测接收机 |
CN108573271A (zh) * | 2017-12-15 | 2018-09-25 | 蔚来汽车有限公司 | 多传感器目标信息融合的优化方法及装置、计算机设备和记录介质 |
CN108573271B (zh) * | 2017-12-15 | 2022-06-28 | 上海蔚来汽车有限公司 | 多传感器目标信息融合的优化方法及装置、计算机设备和记录介质 |
CN108333569A (zh) * | 2018-01-19 | 2018-07-27 | 杭州电子科技大学 | 一种基于phd滤波的异步多传感器融合多目标跟踪方法 |
CN108344981A (zh) * | 2018-01-19 | 2018-07-31 | 杭州电子科技大学 | 面向杂波的多传感器异步检测tsbf多目标跟踪方法 |
CN108333569B (zh) * | 2018-01-19 | 2021-01-12 | 杭州电子科技大学 | 一种基于phd滤波的异步多传感器融合多目标跟踪方法 |
CN108734725A (zh) * | 2018-04-11 | 2018-11-02 | 杭州电子科技大学 | 基于高斯过程的概率数据关联滤波扩展目标跟踪方法 |
CN108734725B (zh) * | 2018-04-11 | 2020-09-29 | 杭州电子科技大学 | 基于高斯过程的概率数据关联滤波扩展目标跟踪方法 |
CN108717702A (zh) * | 2018-04-24 | 2018-10-30 | 西安工程大学 | 基于分段rts的概率假设密度滤波平滑方法 |
CN108717702B (zh) * | 2018-04-24 | 2021-08-31 | 西安工程大学 | 基于分段rts的概率假设密度滤波平滑方法 |
CN109670142B (zh) * | 2019-01-07 | 2023-05-02 | 杭州电子科技大学 | 一种基于随机有限集的可分辨机动群目标状态估计方法 |
CN109670142A (zh) * | 2019-01-07 | 2019-04-23 | 杭州电子科技大学 | 一种基于随机有限集的可分辨机动群目标状态估计方法 |
CN110395251B (zh) * | 2019-06-27 | 2021-07-02 | 驭势(上海)汽车科技有限公司 | 一种基于多传感器融合数据的自动紧急制动决策方法 |
CN110395251A (zh) * | 2019-06-27 | 2019-11-01 | 驭势(上海)汽车科技有限公司 | 一种基于多传感器融合数据的自动紧急制动决策方法 |
CN110472086A (zh) * | 2019-08-02 | 2019-11-19 | 西安工程大学 | 一种基于视网膜关键特征提取的骨架图像检索方法 |
CN110472086B (zh) * | 2019-08-02 | 2023-01-31 | 西安工程大学 | 一种基于视网膜关键特征提取的骨架图像检索方法 |
CN111340853A (zh) * | 2019-12-04 | 2020-06-26 | 杭州电子科技大学 | 基于ospa迭代的多传感器gmphd自适应融合方法 |
CN111340853B (zh) * | 2019-12-04 | 2023-06-02 | 杭州电子科技大学 | 基于ospa迭代的多传感器gmphd自适应融合方法 |
WO2024001629A1 (zh) * | 2022-07-01 | 2024-01-04 | 重庆邮电大学 | 一种面向智能驾驶车辆的多传感器融合方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN104778358B (zh) | 2017-11-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104778358A (zh) | 多传感器存在监测区域部分重叠的扩展目标跟踪方法 | |
CN111722214B (zh) | 雷达多目标跟踪phd实现方法 | |
CN103729637A (zh) | 基于容积卡尔曼滤波的扩展目标概率假设密度滤波方法 | |
EP2169422A1 (en) | System and method for acoustic tracking an underwater vehicle trajectory | |
CN107066806B (zh) | 航迹关联方法及装置 | |
CN106443622A (zh) | 一种基于改进联合概率数据关联的分布式目标跟踪方法 | |
CN103017771B (zh) | 一种静止传感器平台的多目标联合分配与跟踪方法 | |
CN107084714A (zh) | 一种基于RoboCup3D的多机器人协作目标定位方法 | |
CN106093951A (zh) | 基于超声波传感器阵列的物体跟踪方法 | |
CN105372659A (zh) | 道路交通监控多目标探测跟踪方法及跟踪*** | |
CN103869279B (zh) | 一种多传感器平台的多目标定位跟踪方法 | |
CN106054151A (zh) | 基于数据关联算法的雷达多目标跟踪优化方法 | |
CN101221238A (zh) | 基于高斯均值移动配准的动态偏差估计方法 | |
CN103448730A (zh) | 一种高速公路汽车追尾碰撞预警关键参数估计方法 | |
CN104090262A (zh) | 一种基于多采样率多模型融合估计的移动目标跟踪方法 | |
CN103759732A (zh) | 一种角度信息辅助的集中式多传感器多假设跟踪方法 | |
CN105444763A (zh) | 一种imu室内定位方法 | |
CN105022055A (zh) | 一种imu室内定位方法 | |
Tsogas et al. | Unscented Kalman filter design for curvilinear motion models suitable for automotive safety applications | |
CN108344981A (zh) | 面向杂波的多传感器异步检测tsbf多目标跟踪方法 | |
CN107064865A (zh) | 基于深度聚类的极坐标动态规划无源协同定位方法 | |
CN105844217A (zh) | 一种基于量测驱动新生目标强度估计的phd多目标跟踪方法 | |
Zhu et al. | Multi-robot joint localization and target tracking with local sensing and communication | |
CN105021199A (zh) | 基于ls 的多模型自适应状态估计方法及*** | |
CN102595309A (zh) | 一种基于无线传感器网络的穿墙跟踪方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20171110 Termination date: 20180409 |