公开/公告号CN112711025A
专利类型发明专利
公开/公告日2021-04-27
原文格式PDF
申请/专利权人 中国科学院声学研究所;
申请/专利号CN201911016703.2
申请日2019-10-24
分类号G01S15/66(20060101);G01S7/539(20060101);G01S7/537(20060101);
代理机构11472 北京方安思达知识产权代理有限公司;
代理人陈琳琳;李彪
地址 100190 北京市海淀区北四环西路21号
入库时间 2023-06-19 10:46:31
技术领域
本发明属于多目标跟踪及数据融合领域,具体涉及一种水下多站联合多目标跟踪方法及系统。
背景技术
水下传感器网络是在指定海域内按一定规则布放多个被动声纳基阵的分布式系统,单个被动声纳基阵也称为观测节点。对于被动声纳基阵,水平方位量测是其能获取的最容易也是最重要的目标信息。
为了通过多站方位量测的联合来实现多目标跟踪,传统的先关联后跟踪方法存在关联复杂、跟踪效果受限于关联正确率等问题,Mahler等基于随机有限集理论(RandomFinite Set,RFS)提出一套完整多目标跟踪思路,该方法不需要进行数据关联处理,并且适应目标数变化的场景。由于最优的RFS跟踪方法面临的巨大组合复杂性,只可能在少量目标存在时实现,为了提高方法的实用性,提出多目标矩近似和多伯努利近似两种思路。在非线性场景中,搭载粒子滤波的矩近似方法需要以粒子聚类的方式获得多目标后验状态估计,当目标数估计错误时,估计值偏差严重。多伯努利近似方法通过将每个目标单独建立多伯努利表达的方式,无需使用聚类方式获得目标的后验状态,估计精度更高。针对多站观测背景,利用迭代的多伯努利滤波器(multi-Bernoulli,MeMBer),完成多站量测对目标的迭代矫正,实现多被动声纳站系统的目标跟踪。该方法原理简单并且易于实现,但是其目标跟踪结果受观测节点的量测更新顺序影响。为了避免这些问题,Saucan等对多站MeMBer(Multi-sensor MeMBer,MS-MeMBer)的预测和更新模型进行理论推导,并采用一阶矩近似的方式获得目标后验密度的多伯努利形式。该方法的目标跟踪精度更高,并且不受节点更新顺序影响。但是由于新生目标在检测区域内随机出现,如何简单、高效地找到新生目标位置则是一个不小的问题。而且在目标进行目标轨迹更新时,往往会存在许多虚假的短航迹,那么如何输出连续、稳定的航迹也需要进行考量。
实际应用中,需要一种计算量适中,并且能够实时输出连续、稳定航迹的多目标跟踪方法。
发明内容
本发明的目的在于克服现有基于多站方位联合多目标跟踪方法中的新目标初始化问题以及在航迹输出时航迹不稳定,并且存在虚假短航迹等问题。利用节点分对组合随机观测思想生成新目标,并利用多站多伯努利滤波器进行目标的一步预测和量测更新,最后根据统计双门限思想将目标的存在概率与第一门限相比较,对超过该门限的检测次数进行计数器累加,并将结果与第二门限比较来控制目标航迹的实时输出。
为实现上述目的,本发明提出了一种水下多站联合多目标跟踪方法;该方法在每个采样时刻通过联合多观测节点的方位量测信息,实现目标的轨迹跟踪以及目标数估计;所述方法包括:
在当前采样时刻,将观测节点两两分对,进行观测对组合,以相同概率随机选择观测对组合进行方位量测交叉定位,获取新生目标集;由此生成当前时刻的目标信息;所述目标信息包括每个目标的轨迹;
将当前时刻的目标信息以及上一时刻的目标信息作为多站多伯努利滤波器的输入,并进行一步预测以及量测更新,输出当前时刻目标的最大后验状态估计;
将目标的存在概率与第一门限相比较,并对超过该门限的检测次数进行计数器累加,最后将累加结果与第二门限比较,控制目标航迹的实时输出。
作为上述方法的一种改进,所述将观测节点两两分对,进行观测对间组合,具体包括:
将所有观测节点随机分对,则存在
对观测节点对进行组合,其组合原则满足:
每组包含需要全部的观测节点;
当节点数S为偶数时,每个节点在组合中只能出现一次;
当节点数S为奇数时,有且只有其中一个节点在组合中会出现两次,除此之外其他节点在组合中只能出现一次。
则(i,j)
作为上述方法的一种改进,所述以相同概率随机选择观测对组合进行方位量测交叉定位,获取新生目标集,具体包括:
获取当前t
按顺序对所有观测节点对的方位量测进行交叉定位,得到新生目标集,其包括每个新生目标的轨迹;
对新生目标集进行如下处理:
根据设定观测区域大小,滤除落到观测区域外的点集;
根据节点探测能力大小,滤除落在节点探测能力圈外的点集;
滤除落在已存在目标附近的点集;
合并距离相近的目标点集。
作为上述方法的一种改进,所述将当前时刻的目标信息以及上一时刻的目标信息作为多站多伯努利滤波器的输入,并进行一步预测以及量测更新,输出当前时刻目标的最大后验状态估计;具体包括:
t
其中,
其中
分别为目标一步预测集和当前目标集,M
针对于已存在的目标,其多伯努利状态
其中,f
针对于t
定义t
其中M
定义观测节点s量测集合的子集
|W
假设节点s的检测概率为p
其中
p
式中p
即t
其中:
其中,
作为上述方法的一种改进,所述将目标的存在概率与第一门限相比较,并对超过该门限的检测次数进行计数器累加,最后将累加结果与第二门限比较,控制目标航迹的实时输出,具体包括:
分别定义为航迹生成质量和航迹消失质量:
其中,B
在航迹起始时刻的质量打分为0,即B
在航迹建立阶段,此时B
λ
在航迹维持阶段,此时B
通过将t
D
则删除该目标;
如果航迹生成质量B
B
则将该目标设为确定性目标,并输出该目标的后验状态估计。
本发明还提供了一种水下多站联合多目标跟踪系统,所述系统包括:
目标信息获取模块,用于在当前采样时刻,将观测节点两两分对,进行观测对组合,以相同概率随机选择观测对组合进行方位量测交叉定位,获取新生目标集;由此生成当前时刻的目标信息;所述目标信息包括每个目标的轨迹;
目标的最大后验状态估计模块,用于将当前时刻的目标信息以及上一时刻的目标信息作为多站多伯努利滤波器的输入,并进行一步预测以及量测更新,输出当前时刻目标的最大后验状态估计;
目标航迹的实时输出模块,用于将目标的存在概率与第一门限相比较,并对超过该门限的检测次数进行计数器累加,最后将累加结果与第二门限比较,控制目标航迹的实时输出。
本发明的优势在于:
1、相比于全局交叉定位生成新目标的方式,基于节点分对组合随机观测的新目标生成方法降低了方法复杂度;
2、通过统计双门限航迹生成的方式,能够实时输出稳定、持续的目标航迹,并同时滤除虚假目标形成的短航迹;
3、本发明的方法适用于任何目标出入的场景,并且对场景内的目标能够实时输出稳定、持续的航迹;
4、仿真结果证明本发明的方法具有良好的目标跟踪性能。
附图说明
图1为本发明的水下多站联合多目标跟踪方法的流程图;
图2为本发明的基于节点分对组合随机观测的新目标生成的流程图;
图3为本发明的基于统计双门限的航迹生成的流程图;
图4(a)为观测节点部署和真实目标运动示意图;
图4(b)为真实目标数的示意图;
图5(a)为本发明的方法的跟踪估计结果示意图;
图5(b)为本发明的方法的目标数估计数的示意图。
具体实施方式
下面结合附图和具体实施例对本发明的技术方案进行详细的说明。
本发明提出一种水下多站联合多目标跟踪方法,该方法在每个采样时刻通过联合多节点的方位量测信息,来实现目标的轨迹跟踪以及目标数目估计。该方法有两处改进:包括基于节点分对组合随机观测的新目标生成方法和基于统计双门限的航迹生成方法。如图1所示,包括如下步骤:
1)为了获得新生目标状态,将观测节点两两分对,进行观测对间组合,并以相同概率随机选择观测对组合来进行方位量测间交叉定位,在滤除与已存在目标位置临近的虚假目标之后生成新目标信息;
2)将生成的新目标以及前一时刻的保留目标作为多站多伯努利滤波器的输入,并进行一步预测以及量测更新,输出当前时刻目标的最大后验状态估计;
3)为了输出连续、稳定航迹,根据统计双门限思想设计第一门限和第二门限,将目标的存在概率与第一门限相比较,并对超过该门限的检测次数进行计数器累加,最后将结果与第二门限比较来控制目标航迹的实时输出。
本发明提出的一种水下多站联合多目标跟踪方法,在每个采样时刻通过联合多节点的方位量测信息,在未知目标初始状态情况下,实现目标的轨迹跟踪以及目标数目估计,并且实时输出目标航迹。具体包括:
步骤1)在每个采样时刻的新目标生成过程中,可以将多节点在同一观测时刻的观测量进行交叉定位,在滤除与存在目标位置靠近的定位目标之后,可将剩余的目标当成新生目标。
但是随着观测节点数增加,这种全局交叉定位目标生成方法的计算量迅速增大,其计算复杂度为
将所有观测节点随机分对,则存在
(1)每组包含需要全部的观测节点;
(2)当节点数S为偶数时,每个节点在组合中只能出现一次;
(3)当节点数S为奇数时,有且只有其中一个节点在组合中会出现两次,除此之外其他节点在组合中只能出现一次。
例如:当节点数为4,按照上述原则存在以下分组方式:
{(Z
当节点数为3,按照上述原则存在以下分组方式:
{(Z
随机观测的思想就是在观测时刻以相同的概率随机选取一组观测组合作为观测数据源,例如节点数为4时,在k时刻均以1/3的概率选取{(Z
基于节点分对组合随机观测新目标生成方法的具体实现步骤如图2所示:
第一步,将当前t
第二步,按随机观测思想,将所有观测节点进行两两组合,得到所有观测节点对的集合;
第三步,按顺序对所有观测节点对的方位量测进行交叉定位,得到新生目标点集;
第四步,根据设定观测区域大小,滤除落到观测区域外的点集;
第五步,根据节点探测能力大小,滤除落在节点探测能力圈外的点集;
第六步,滤除落在已存在目标附近的点集;
第七步,合并距离相近的目标点集;
第八步,判断是否遍历所有观测对,并输出新目标点集。
步骤2)在多目标跟踪过程中,MeMBer滤波方法通过将每个时刻的多目标RFS近似为多伯努利形式来实现目标集合的迭代更新。也就是说,假设单目标m以1-r
其中
Γ
为了计算方便,假设各目标运动过程相互独立,各量测之间相互独立,杂波服从泊松分布且独立于目标量测。下面根据MS-MeMBer滤波器方法原理给出状态集合Γ
1.预测
由于预测步骤不需要考虑观测节点信息,因此多节点预测与单节点预测过程相同。假设t
则预测过程的多目标密度可以分为前一时刻目标的一步预测以及新目标的产生两个部分,即:
其中
分别为目标一步预测集和新生目标集,M
其中,f
2.更新
定义t
N
其中M
其中F[g
为了得到G
表示集合W
假设节点s的检测概率为p
其中
p
式中p
定义与观测子集
其中,
其中
将公式(16)代入公式(10),并按公式(17)的一阶矩计算方式,对公式(10)求泛函导数可得:
其中:
虽然后验概率密度f
其中:
为了获得t
多站多伯努利滤波器的预测更新过程如下:
预测过程:
输入为前一时刻的目标的多伯努利状态
第一步:对前一时刻已存在目标的多伯努利状态
第二步:根据节点分对随机观测方法,生成新目标点集以及对应的多伯努利状态
输出目标预测的多伯努利目标状态集合
更新过程:
输入目标预测的多伯努利目标状态集合
第一步:基于分治贪心的思想,在量测集合Z
第二步,根据选定的划分方式P以及划分的观测子集
其中:
输出多目标多伯努利状态集合Γ
步骤3)在航迹生成的过程中,由于在水下低信噪比环境中,单节点的目标检测存在目标漏检的情况;同时,通过交叉定位来生成新目标的方式往往会伴生出许多虚假的短航迹;为了保证能输出连续、稳定的航迹,借用统计双门限检测思想,提出基于统计双门限的航迹生成方法。
如图3所示,所谓统计双门限检测思想,就是将若干个连续观测周期内的检测量Θ逐个与第一门限λ
基于统计双门限的航迹生成方法延续了双门限的思想,在第一门限判断时,选用目标的存在概率r作为第一门限检测量,即Θ=r。在进行第二门限判断时,为了实现对目标航迹的即时判断和实时更新,引入两个非负整数来实时控制目标航迹的起始和终止,分别定义为航迹生成质量B和航迹消失质量D,
其中,在航迹起始时刻的质量打分为0,即B
1航迹建立
在航迹建立阶段,此时B
2航迹维持
在航迹维持阶段,此时B
通过将当前时刻的航迹质量B和D与第二门限相比较来控制目标航迹的起始和终止。如果航迹消失质量D满足:
D
则删除该目标。同理,如果航迹生成质量B满足:
B
则将该目标设为确定性目标,并输出该目标的后验状态估计。
本发明还提供了一种水下多站联合多目标跟踪系统,所述系统包括:
目标信息获取模块,用于在当前采样时刻,将观测节点两两分对,进行观测对组合,以相同概率随机选择观测对组合进行方位量测交叉定位,获取新生目标集;由此生成当前时刻的目标信息;所述目标信息包括每个目标的轨迹;
目标的最大后验状态估计模块,用于将当前时刻的目标信息以及上一时刻的目标信息作为多站多伯努利滤波器的输入,并进行一步预测以及量测更新,输出当前时刻目标的最大后验状态估计;
目标航迹的实时输出模块,用于将目标的存在概率与第一门限相比较,并对超过该门限的检测次数进行计数器累加,最后将累加结果与第二门限比较,控制目标航迹的实时输出。
实例
下面结合仿真数据对本发明的方法做进一步详细描述。
参数设置:假设观测区域的大小为6000×5000m,四个观测节点分布在观测区域的四个顶点位置,分别为(0,0)、(6000,0)、(6000,5000)、(0,5000)。设置观测采样帧数为400次,则两次观测采样的间隔(即帧间隔)为6s。在观测时间段内陆续出现五个运动目标,假设均作匀速直线运动。目标初始状态以及存在时间如表1所示,观测节点部署以及目标运动模型如图4(a)和图4(b)所示。
表1 目标初始状态与存在时间段
每个观测节点观测过程中获取方位信息,包括目标的方位量测和杂波,设置杂波个数服从泊松分布。利用本发明中方法进行多站多目标跟踪,方法配置参数如表2所示,表中无量干的参数表示概率。
表2 方法仿真参数
图5(a)和图5(b)给出了本发明方法的轨迹跟踪以及目标数估计结果与真实运动模型的对比,观察图5(a)中轨迹跟踪结果,可知本发明中方法能够对多目标进行稳定、持续地跟踪;观察图5(b)中目标数估计结果,可知本发明中方法能够使用目标数变化场景,但是在目标变化的时刻,也存在滞后现象,如图5(b)中小图所示,这是由于统计双门限方法在航迹起始时需要一段时间的航迹累积引起。
最后所应说明的是,以上实施例仅用以说明本发明的技术方案而非限制。尽管参照实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,对本发明的技术方案进行修改或者等同替换,都不脱离本发明技术方案的精神和范围,其均应涵盖在本发明的权利要求范围当中。
机译: 多目标跟踪系统,多目标跟踪方法和多目标跟踪程序。
机译: 使用相同的多目标跟踪系统和多目标跟踪方法
机译: 适用于杂波环境的多目标跟踪方法和跟踪系统