基于斜率约束和回溯搜索的水下多目标跟踪方法技术

本发明专利技术提供了一种基于斜率约束和回溯搜索的水下多目标跟踪方法，首先基于方位测量数据和水下目标运动学分析，利用门限阈值的方法检测出水下的多目标。然后，基于传统多假设跟踪算法框架设计一种新的基于斜率约束和共用量测的假设生成规则。该多目标生成规则体现在，当航迹正常跟踪时，通过斜率拟合约束的方式进行跟踪，保持在每个时刻跟踪后拟合当前目标的斜率，通过比较当前斜率和历史拟合的斜率的差的阈值来判断是否出现航迹中断。当航迹中断时，通过回溯搜索的方法确定中断起始航迹点，利用容积卡尔曼滤波对中断航迹预测和补偿，同时对假设生成结果减枝，以达到降低算法空间复杂度的目的，进而提交多目标跟踪的精度。

【技术实现步骤摘要】
基于斜率约束和回溯搜索的水下多目标跟踪方法
本专利技术涉及多目标被动跟踪和策略优化领域，涉及一种基于斜率约束和回溯搜索的多目标跟踪方法。
技术介绍
水下多目标的检测和被动跟踪相对于主动跟踪具有非线性、轨迹易中断、干扰目标较多等特点。在跟踪过程中，由于杂波、多途干扰、信噪比低、目标多等原因，要实现水下被动多目标的检测和跟踪是一个具有挑战的任务。在水下被动目标检测和跟踪任务中，一般通过宽带能量检测得到目标方位的谱数据，并以时间方位历程图(Bearing-TimeRecording，BTR)形式进行显示，再基于BTR图进行目标跟踪的研究。在目标检测的任务中，基本的检测原理是引入隐马尔可夫模型(HiddenMarkovModel，HMM)，把频率、频率变化率、方位及方位变化率作为HMM的状态，实现基于线谱的自动检测；在被动目标跟踪任务中，通常使用数据关联算法来实现被动跟踪。但在处理多目标交叉问题时，关联正确率很低。因此，水下的被动多目标跟踪仍具有以下几个问题：1)由于水下弱目标多、杂波干扰等原因，很难实现多目标的检测；2)在BTR图中为信号能量较弱的条件下，容易出现航迹中断和消失的现象，很难实现多目标的实时跟踪；3)传统数据关联的算法不能有效解决航迹交叉的问题。因此，在水下环境下，提高多目标跟踪系统性能具有重要的意义。
技术实现思路
本专利技术面向水下多目标跟踪的技术需求，为解决杂波干扰和弱信号条件下目标航迹中断和交叉等问题，提高水下多目标跟踪系统的精度，提出了一种基于斜率约束和回溯搜索的水下多目标跟踪方法，可用于水下多杂波干扰、弱信号、低信噪比等环境，有效提高目标跟踪的实时性和精度。本专利技术方法将目被动跟踪方法和策略优化机制结合，引入斜率约束和回溯搜索两种策略分别用于水下多目标的跟踪和目标航迹交叉和中断的补偿，从而提高目标跟踪的精度。为了达到上述目的，本专利技术提供如下技术方案：基于斜率约束和回溯搜索的水下多目标跟踪方法，包括如下步骤：(1)初始化INS/CNS水下被动多目标检测跟踪系统，记录目标方位测量数据，依据水下目标运动学分析和利用门限阈值的方法检测出水下的多目标；(2)在传统多假设跟踪算法框架下，设计一种基于斜率约束和共用量测的假设生成规则。当航迹正常跟踪时，使用斜率拟合约束的方式进行跟踪，通过比较候选目标点斜率与当前目标航迹的拟合斜率的差的阈值来判断是否可以与当前目标关联。如果所有候选目标点都不符合阈值设定则认为是中断，触发中断补偿策略(3)；(3)当航迹中断时，通过回溯搜索的方法确定中断起始航迹点，利用容积卡尔曼滤波对中断航迹预测和补偿，同时对假设生成结果剪枝，解决目标航迹中断错连的问题。进一步的，所述步骤(1)具体包括如下过程：假设在二维监测区域内有多个目标，采用匀速运动模型模拟每个目标的位置变化情况，假定一个目标在k时刻的状态矢量表示为可表示为xk＝[x,vx,y,vy]Txk状态矢量中包括x,y方向上的位置和速度。所以，目标的状态方程可以表示为：xk＝Fxk-1+Gwk(1)其中，F表示目标的状态转移矩阵，G为状态噪声强度的输入矩阵。通常假设过程噪声wk服从均值为0，协方差矩阵为Q的高斯分布，假设过程噪声和量测噪声相互独立；假设跟踪目标和探测传感器位于同一个平面内，确定被动探测传感器的个数和位置后，即可得到某一目标xk的方位角：其中，βk表示第k个目标的方位角，(a,b)表示某一探测传感器的位置坐标。进一步的，所述步骤(2)具体包括如下过程：共用量测策略：假设在t时刻，目标的总个数为M，待关联目标的状态矩阵为X＝[x1,x2,...,xi,...,xM]，i表示目标的批号，xi表示第i个目标的状态向量，t时刻的量测矩阵为Y＝[y1,y2,...,yj,...,ym]，m表示量测目标的个数，yj表示第j个量测值。在多目标关联中，我们给出可行性的假设：(1)对于每一个目标，最多只有一个量测与其关联；(2)对于每一个量测，允许多个目标与其关联，允许目标之间共用量测值。因此，数据关联的目标函数可以表示为：其中gi,j表示目标i和量测j的关联程度；uij表示目标i和量测j的关联情况。对于目标i和量测j的关联程度，可以用似然函数来表示：其中，zi表示第i个目标在该时刻的预测值；表示第i个目标量测值和实际第j个目标的方位值的差；S表示残差。当目标的预测值和该目标当前时刻的目标值正确关联时，目标的关联程度越大。关联矩阵U的表达式为：对于改进的MHT算法的约束条件为：其中uij的值为0或1，当量测量和第i个目标xi关联时，uij为1，否则为0。kployfit表示原本目标历史航迹拟合曲线的斜率；kcurrent表示加入假设量测量之后当前目标和量测量拟合的斜率，约束中需要保证两次拟合的斜率同号，这种方式可以排除估计斜率非同号的假设。斜率约束策略：当航迹正常跟踪时，通过斜率拟合约束的方式进行跟踪。具体来说，通过比较候选目标点斜率与当前目标航迹的拟合斜率的差的阈值来判断是否可以与当前目标关联。因此，记当前候选目标点的斜率k和当前目标航迹拟合的斜率kcur之间的差为Δk，设定固定阈值用于判断候选目标点是否可以和当前目标航迹关联。如果不符合阈值设定范围，则认为出现航迹中断。进一步的，所述步骤(3)具体包括如下过程：利用时间方位历程图对航迹目标进行跟踪时，经常会因为目标本身的轨迹交叉和信号的丢帧，导致目标轨迹在关联之后出现断裂，这时候关联算法将无法工作。因此，需要对断裂轨迹进行预测。在容积卡尔曼滤波(CubatureKalmanfilter,CKF)中，设置滤波器的初始状态量和协方差xk＝E(x0),Pk＝cov(x0)，滤波系统可分为时间更新和量测更新两部分：(1)时间更新部分：式中，chol(·)表示Cholesky分解；Pk-1|k-1表示k-1时刻的预测均方误差；Sk-1|k-1表示最优滤波估计协方差Pk-1|k-1的特征值的平方根；为k-1时刻滤波器输出的最优状态估计；xk-1|k-1,i表示计算容积点；{ξi}表示归一化容积点可设置为：(2)计算状态量的估计值和协方差Pk|k-1：是在k-1时刻对k时刻系统状态的估计值；Pk|k-1是系统在k-1时刻对下一时刻k的一步预测均方误差；ek|k-1表示状态量之间的估计误差；ωi表示随机权重，通常取(3)量测更新求解预测协方差矩阵和计算容积点xk|k-1,i：计算传播容积点zk|k-1,i并得到量测量估计值zk|k-1,i＝h(xk|k-1,i)(12)(4)计算到量测量的估计值之后，可以计算相关协方差：是在k-1时刻对k时刻的量测量预测值；Pzz,k|k-1，Pxz,k|k-1表示自相关和互相关本文档来自技高网...

【技术保护点】
1.基于斜率约束和回溯搜索的水下多目标跟踪方法，其特征在于，包括如下步骤：/n(1)初始化水下被动多目标检测跟踪系统，记录目标方位测量数据，利用门限阈值的方法检测出水下的多目标；/n(2)在传统多假设跟踪算法框架下，设计一种基于斜率约束和共用量测的假设生成规则，当航迹正常跟踪时，使用斜率拟合约束的方式进行跟踪，通过比较候选目标点斜率与当前目标航迹的拟合斜率的差的阈值来判断是否可以与当前目标关联，如果所有候选目标点都不符合阈值设定则认为是中断，触发中断补偿策略(3)；/n(3)当航迹中断时，通过回溯搜索的方法确定中断起始航迹点，利用容积卡尔曼滤波对中断航迹预测和补偿，同时对假设生成结果减枝，以达到降低算法空间复杂度的目的。/n

【技术特征摘要】
1.基于斜率约束和回溯搜索的水下多目标跟踪方法，其特征在于，包括如下步骤：
(1)初始化水下被动多目标检测跟踪系统，记录目标方位测量数据，利用门限阈值的方法检测出水下的多目标；
(2)在传统多假设跟踪算法框架下，设计一种基于斜率约束和共用量测的假设生成规则，当航迹正常跟踪时，使用斜率拟合约束的方式进行跟踪，通过比较候选目标点斜率与当前目标航迹的拟合斜率的差的阈值来判断是否可以与当前目标关联，如果所有候选目标点都不符合阈值设定则认为是中断，触发中断补偿策略(3)；
(3)当航迹中断时，通过回溯搜索的方法确定中断起始航迹点，利用容积卡尔曼滤波对中断航迹预测和补偿，同时对假设生成结果减枝，以达到降低算法空间复杂度的目的。


2.根据权利要求1所述的基于斜率约束和回溯搜索的水下多目标跟踪方法，其特征在于，所述步骤(1)具体包括如下过程：
假设在二维监测区域内有多个目标，采用匀速运动模型模拟每个目标的位置变化情况，假定一个目标在k时刻的状态矢量表示为：
xk＝[x,vx,y,vy]T
xk状态矢量中包括x,y方向上的位置和速度；所以，目标的状态方程可以表示为：
xk＝Fxk-1+Gwk(1)
其中，



F表示目标的状态转移矩阵，G为状态噪声强度的输入矩阵；假设过程噪声wk服从均值为0，协方差矩阵为Q的高斯分布，假设过程噪声和量测噪声相互独立；
假设跟踪目标和探测传感器位于同一个平面内，确定被动探测传感器的个数和位置后，即可得到某一目标xk的方位角：



其中，βk表示第k个目标的方位角，(a,b)表示某一探测传感器的位置坐标。


3.根据权利要求2所述的基于斜率约束和回溯搜索的水下多目标跟踪方法，其特征在于，所述步骤(2)具体包括如下过程：
(一)共用量测策略：
假设在t时刻，目标的总个数为M，待关联目标的状态矩阵为：
X＝[x1,x2,...,xi,...,xM]
i表示目标的批号，xi表示第i个目标的状态向量；t时刻的量测矩阵为：
Y＝[[y1,y2,...,yj,...,ym]]
m表示量测目标的个数，yj表示第j个量测值；
在多目标关联中，给出可行性的假设：
(1)对于每一个目标，最多只有一个量测与其关联；
(2)对于每一个量测，允许多个目标与其关联，允许目标之间共用量测值；
因此，数据关联的目标函数可以表示为：



其中gi,j表示目标i和量测j的关联程度；uij表示目标i和量测j的关联情况。对于目标i和量测j的关联程度，可以用似然函数来表示：

【专利技术属性】
技术研发人员：陈熙源，张雨，朱敏，
申请(专利权)人：东南大学，
类型：发明
国别省市：江苏;32