一种多传感器平台的多目标定位跟踪方法技术

本发明专利技术涉及一种多传感器平台的多目标定位跟踪方法，多传感器多目标无源交叉定位时存在虚假点的问题，且随着传感器和目标的数量的增加，虚假点的数量也急剧增加，针对这个问题，本发明专利技术提出了一种对目标无源定位跟踪的新方法，即首先通过判断预测点到传感器与目标构成的传感器方程的最小距离来选取三个方程，避免了大量虚假点的产生，若三个方程有来自同一个传感器的则在同一传感器的方程中任意选取一个，其次以传感器方程的交点为基础获取目标量测，最后再通过运用UF(无味滤波)算法便得到目标点的位置。

A multi-target location and tracking method for multisensor platform

Multi target localization in the invention relates to a multi sensor platform tracking method, the existence of false point problem of multi sensor multi target passive cross location, and with the increase in the number of sensors and targets, the number of false points has increased dramatically, to solve this problem, the present invention provides a new target for passive localization and tracking the first method, by determining the minimum distance from a point to a target sensor and sensor equation to select three equation prediction, avoid the false point, if the three equations are derived from the same sensor at the same sensor equation in a randomly selected, followed by the intersection of sensor equation the basic target measurement, and finally through the use of UF (unscented filtering) algorithm and gets the position of the target.

【技术实现步骤摘要】
一种多传感器平台的多目标定位跟踪方法
本专利技术属于多传感器多目标跟踪领域，特别涉及一种基于多传感器平台的多目标定位跟踪方法。
技术介绍
无源定位系统完全被动地接收目标发射的电磁波进行定位和跟踪，具有隐蔽性好，生存能力强的特点，当只利用单个传感器的方位信息对目标进行无源定位时，目标的状态估计问题为非线性，且距离越远时估计越不乐观，这些特点决定了应该选用多传感器对多目标进行跟踪定位，这也是本专利技术的现实依据。对于多个目标的定位需要进行预处理，主要是将不同目标的测量数据进行归并，使同一个目标的测量数据放在一起以备定位计算之用。预处理主要包括信号的分选和识别技术。多目标跟踪过程的关键是如何进行有效的数据关联。由于观测数据不可避免的存在着环境噪声和测量误差，并且缺乏跟踪环境的先验知识，不能确定目标的数量，无法判定观测数据是由真实目标还是虚假产生，以及由哪一个真实目标产生。这些不确定因素破坏了观测与目标之间的对应关系。
技术实现思路
本专利技术针对现有技术的不足，提供了一种静止传感器平台的多传感器多目标联合定位跟踪方法。其具体内容如下：1.系统建模；1.1给出线性多传感器多目标系统，如下：其中，xk是目标状态向量，pk,x,pk,y分别为k时刻目标在直角坐标平面上的X轴和Y轴上的坐标，分别为k时刻目标在直角坐标平面上的X轴和Y轴方向上的速度，Ak是目标状态转移矩阵，Bk是噪声矩阵，zk+1是系统量测，θk+1是观测矩阵；wk,vk+1分别为过程噪声和量测噪声，服从标准的高斯分布。1.2传感器方程以及目标预测点到传感器方程的最小距离方程模型为：y＝K*x+b其中，K为传感器方程的斜率，(x,y)为传感器方程上点的坐标，b为传感器方程截距，表示k时刻目标j的预测值到传感器i与目标构成的传感器方程之间的距离，为k时刻目标j的预测值到传感器i与目标构成的传感器方程的斜率，bk,i是一个传感器i所构成的传感器方程的截距，xk,j和yk,j为预测点的位置。1.3选择三个传感器和五个目标作为模型，在上述的最小距离方程模型中，对每一个目标j处都选择距离最小的三个方程。2.定位跟踪系统的方程优化；2.1观测方程的优化；针对被动传感器观测方程，给出如下所示的表示：yk＝Hk,1-1Hk,2公式推导过程如下：Kk,1＝tan(zk,1)Kk,2＝tan(zk,2)Kk,3＝tan(zk,3)其中，Kk,1，Kk,2，Kk,3是k时刻选择的传感器斜率，bk,1，bk,2，bk,3则为k时刻传感器的截距，yk,1，yk,2，yk,3为三个传感器方程相交的估计目标在直角坐标平面上的位置，zk,1，zk,2，zk,3为系统量测。3.观测方程的进一步优化；3.1在由目标预测值选取三个最小距离传感器方程时，当有两个方程来自同一个传感器则舍弃任意一个，此时系统的观测方程如下所示：Kk,1＝tan(zk,1)Kk,2＝tan(zk,2)其中，Kk,1，Kk,2是k时刻选择的传感器斜率，bk,1，bk,2则为k时刻传感器的截距，yk为两个方程相交的估计目标在直角坐标平面上的位置。4.系统方程算法选取；依据如上优化问题获取目标量测之后，接下来需要考虑算法选取问题，在多传感器多目标定位跟踪系统中选取UF(无味滤波)算法。本专利技术的有益效果：本专利技术给出了一种静止传感器平台的多传感器多目标联合定位跟踪方法，通过目标的预测值来选取该点到各个传感器方程的最小距离的三个方程，若有来自同一传感器的两个方程则舍弃任意一个，并且将原先对角度测量的观测方程转换为对目标位置的直接量测方程以实现对目标状态的估计。附图说明图1.多传感器多目标UF定位跟踪过程；图2.多传感器多目标几何定位跟踪过程；图3.UF定位和几何定位的误差分析比较；具体实施方式以下结合附图对本专利技术作进一步说明。本专利技术提供了一种静止传感器平台的多传感器多目标联合定位跟踪方法。其具体实施方式如下：1.系统建模；1.1给出线性多传感器多目标系统，如下：其中，xk是目标状态向量，pk,x,pk,y分别为k时刻目标在直角坐标平面上的X轴和Y轴上的坐标，分别为k时刻目标在直角坐标平面上的X轴和Y轴方向上的速度，Ak是目标状态转移矩阵，Bk是噪声矩阵，zk+1是系统量测，θk+1是观测矩阵；wk,vk+1分别为过程噪声和量测噪声，服从标准的高斯分布。1.2传感器方程以及目标预测点到传感器方程的最小距离方程模型为：y＝K*x+b其中，K为传感器方程的斜率，(x,y)为传感器方程上点的坐标，b为传感器方程截距，表示k时刻目标j的预测值到传感器i与目标构成的传感器方程之间的距离，为k时刻目标j的预测值到传感器i与目标构成的传感器方程的斜率，bk,i是一个传感器i所构成的传感器方程的截距，xk,j和yk,j为预测点的位置。1.3选择三个传感器和五个目标作为模型，在上述的最小距离方程模型中，对每一个目标j处都选择距离最小的三个方程。如图1所示，其给出了在3个传感器、5个目标情景下的算法流程，和传统的多传感器多目标跟踪算法比较，在预测步之后，考虑了目标的预测值到传感器直线方程的最小距离选择问题，然后再依据相应的传感器量测更新目标状态，因此，本专利技术中目标跟踪过程是一个混合多量测的目标跟踪过程。2.定位跟踪系统的方程优化；2.1观测方程的优化；针对被动传感器观测方程，给出如下所示的表示：yk＝Hk,1-1Hk,2公式推导过程如下：Kk,1＝tan(zk,1)Kk,2＝tan(zk,2)Kk,3＝tan(zk,3)...

【技术保护点】
一种多传感器平台的多目标定位跟踪方法，其特征在于该方法包括以下步骤：步骤1.系统建模，具体是：1.1给出线性多传感器多目标系统，如下：

【技术特征摘要】
1.一种多传感器平台的多目标定位跟踪方法，其特征在于该方法包括以下步骤：步骤1.系统建模，具体是：1.1给出线性多传感器多目标系统，如下：其中，xk是目标状态向量，pk，x,pk，y分别为k时刻目标在直角坐标平面上的X轴和Y轴上的坐标，分别为k时刻目标在直角坐标平面上的X轴和Y轴方向上的速度，Ak是目标状态转移矩阵，Bk是噪声矩阵，zk+1是系统量测，θk+1是观测矩阵；wk,vk+1分别为过程噪声和量测噪声，服从标准的高斯分布；1.2传感器方程以及目标预测点到传感器方程的最小距离方程模型为：y＝K*x+b其中，K为传感器方程的斜率，(x,y)为传感器方程上点的坐标，b为传感器方程截距，表示k时刻目标j的预测值到传感器i与目标构成的传感器方程之间的距离，为k时刻目标j的预测值到传感器i与目标构成的传感器方程的斜率，bk,i是一个传感器i所构成的传感器方程的截距，xk,j和yk,j为预测点的位置；1.3选择三个传感器和五个目标作为模型，在上述的最小距离方程模型中，对每一个目标j处都选择距离最小的三个方程；步骤2.定位跟踪系统的方程优化，具体是：2.1观测方程的优化；针对被动传感器观测方程，给出如下所示的表示：yk＝Hk,1-1Hk,2公式推导过程如下：Kk,1＝tan(zk,1)Kk,2＝tan(zk,2)Kk,3＝tan(zk,3)

【专利技术属性】
技术研发人员：刘伟峰，文成林，丁树宇，
申请(专利权)人：杭州电子科技大学，
类型：发明
国别省市：浙江,33