[0044] 以下结合附图对本发明作进一步说明。
[0045] 本发明提供了一种静止传感器平台的多传感器多目标联合定位跟踪方法。其具体实施方式如下:
[0046] 1.系统建模;
[0047] 1.1给出线性多传感器多目标系统,如下:
[0048]
[0049] 其中,xk是目标状态向量, pk,x,pk,y分别为k时刻目标在直角坐标平面上的X轴和Y轴上的坐标, 分别为k时刻目标在直角坐标平面上的X轴和Y轴方向上的速度,Ak是目标状态转移矩阵,Bk是噪声矩阵,zk+1是系统量测,θk+1是观测矩阵;wk,vk+1分别为过程噪声和量测噪声,服从标准的高斯分布。
[0050] 1.2传感器方程以及目标预测点到传感器方程的最小距离方程模型为:
[0051] y=K*x+b
[0052]
[0053] 其中,K为传感器方程的斜率,(x,y)为传感器方程上点的坐标,b为传感器方程截距, 表示k时刻目标j的预测值到传感器i与目标构成的传感器方程之间的距离, 为k时刻目标j的预测值到传感器i与目标构成的传感器方程的斜率,bk,i是一个传感器i所构成的传感器方程的截距,xk,j和yk,j为预测点的位置。
[0054] 1.3选择三个传感器和五个目标作为模型,在上述的最小距离方程模型中,对每一个目标j处都选择距离最小的三个方程。
[0055] 如图1所示,其给出了在3个传感器、5个目标情景下的算法流程,和传统的多传感器多目标跟踪算法比较,在预测步之后,考虑了目标的预测值到传感器直线方程的最小距离选择问题,然后再依据相应的传感器量测更新目标状态,因此,本发明中目标跟踪过程是一个混合多量测的目标跟踪过程。
[0056] 2.定位跟踪系统的方程优化;
[0057] 2.1观测方程的优化;
[0058] 针对被动传感器观测方程,给出如下所示的表示:
[0059] yk=Hk,1-1Hk,2
[0060] 公式推导过程如下:
[0061] Kk,1=tan(zk,1)
[0062] Kk,2=tan(zk,2)
[0063] Kk,3=tan(zk,3)
[0064]
[0065]
[0066]
[0067]
[0068]
[0069]
[0070] 其中,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为系统量测。
[0071] 3.观测方程的进一步优化;
[0072] 3.1在由目标预测值选取三个最小距离传感器方程时,当有两个方程来自同一个传感器则舍弃任意一个,此时系统的观测方程如下所示:
[0073] Kk,1=tan(zk,1)
[0074] Kk,2=tan(zk,2)
[0075]
[0076]
[0077]
[0078]
[0079] yk=Hk,1-1Hk,2
[0080] 其中,Kk,1,Kk,2是k时刻选择的传感器斜率,bk,1,bk,2则为k时刻传感器的截距,yk为两个方程相交的估计目标在直角坐标平面上的位置。
[0081] 4.系统方程算法选取;
[0082] 依据如上优化问题获取目标量测之后,接下来需要考虑算法选取问题,在多传感器多目标定位跟踪系统中选取UF(无味滤波)算法。
[0083] 为了更好地阐释说明本发明,在本发明实验中,使用3个传感器来对目标进行定位跟踪,3个传感器状态分别为
[0084] s1=[-1000m,0m/s,-3000m,0m/s]T,s2=[2000m,0m/s,-3000m,0m/s]T
[0085] s3=[4000m,0m/s,-3000m,0m/s]T
[0086] 5个目标的初始状态分别为:
[0087] x1=[-900m,30m/s,500m,-30m/s]T,x2=[-500m,20m/s,600m,-20m/s]T[0088] x3=[0m,20m/s,700m,-20m/s]T,x4=[500m,20m/s,600m,-20m/s]T
[0089] x5=[900m,30m/s,500m,-30m/s]T
[0090] 图2给出的是利用传统的几何定位方法对多目标进行定位,在三个传感器和五个目标的系统中几何方法实现了对目标的定位,进入三个传感器的观测视场,每个目标由三个传感器负责观测,而每个传感器可以观测多个目标。图中的轨迹给出真实航迹和几何定位航迹,从整个的跟踪过程来看,跟踪精度一般。
[0091] 图3展示的是利用本发明的算法和传统的几何定位算法误差值得分析比较,由图可以看出,在绝大部分情况下本发明的算法的误差值都要小于传统的几何定位算法,即本发明的算法能更好的对多目标进行跟踪定位。
[0092] 最后说明,以上描述仅用以说明本发明的技术方案而非限制其所包含范围,即对本发明的技术方案进行修改或者等同替换,而并未脱离其目的和范围的,均应涵盖于本发明的权利要求范围当中。