[发明专利]序列UD分解的多目标跟踪方法

摘要

本发明公开了一种序列UD分解的多目标跟踪方法，用于解决现有的目标跟踪方法数值结构不稳定导致雷达跟踪过程目标失跟的技术问题。技术方案是对估计误差方差阵进行序列UD分解，建立数值稳定结构模型，没有误差估计的方差阵中有两个半正定矩阵相减，在有限字长的处理系统中能够保证不会产生含有负特征值的对称矩阵。通过对估计误差方差阵的序列UD分解，建立了数值稳定的多目标跟踪结构模型，避免了误差估计的方差阵中两个半正定矩阵相减，在有限字长的处理系统中不会出现数值发散，从而保证了目标跟踪系统的可靠性、避免了雷达跟踪过程目标失跟和整个雷达系统性错误。

主权项

1.一种序列UD分解的多目标跟踪方法，其特征在于包括以下步骤：(1)、定义N个目标跟踪中第i个目标的离散化模型为x_i(k+1)＝Φ(k+1，k)x_i(k)+Λω_i(k)，其中：为状态向量，(x，y，z)为目标在地面参考直角坐标系下的位置坐标，ω_i(k)表示方差为对角阵Q_i(k)的过程噪声向量，Q_i(k-1)＝diag[q_i1(k-1)，q_i2(k-1)，q_i3(k-1)]，q_il(k-1)∈R^1×1(l＝1，2，3)为标量；Φ(k+1，k)＝Φ＝diag[Φ₁，Φ₁，Φ₁]为状态转移矩阵，Λ=∫kT(k+1)TΦ(k+1,τ)Γ(τ)dτ=Λi000Λi000Λi,]]>Γ(t)为系数矩阵，Γ=Γ1000Γ1000Γ1,]]>Γ₁＝[0 0 1]^T，Φ1=1T12T201T001,]]>Λ1=16T312T3TT,]]>T为采样周期；第i个目标的时间更新为：x_i(k/k-1)＝Φx_i(k-1/k-1)U‾i(k/k-1)=ΦUi(k-1/k-1)]]>D‾i(k/k-1)=Di(k-1/k-1)]]>U_i(k/k-1)＝[y₄ y₅…y₁₂]，D_i(k/k-1)＝diag[d₄，d₅，…，d₁₂]其中：x_i(k/k-1)为第i个目标在kT时刻的一步预测值，为对应的一步预测误差的方差阵，初始的y_j为Y^T(k/k-1)的第j列向量，d_j为的第j行第j列对角元素；Y(k/k-1)=U‾i(k/k-1)Λ,]]>D~(k/k-1)=Di(k-1/k-1)00Qi(k-1)]]>U_i(k/k-1)为单位上三角矩阵，D_i(k/k-1)为对角矩阵；←表示改写，例如a←b为用b值改写a；初始条件为x_i(0/0)和(2)、第i个目标观测方程为：z_i(k)＝g_i[x_i(k)]+v_i(k)其中：z_i(k)为对第i个目标的r维观测向量，g_i[x_i(k)]为对应的输出，v_i(k)表示方差为对角阵R_i(k)＝diag[R_i1，R_i2，…，R_ir]测量噪声；计算xi(k/k)=xi(k/k-1)+Gi(k){Σj=1mλij(k)zij(k)-gi[xi(k/k-1)]}]]>其中：为单位上三角矩阵，为对角矩阵，D_ill(k/k-1)为D_i(k/k-1)的第l行第l列元素，U_ijl(k/k-1)为为U_i(k/k-1)的第j行第l列元素；z_ij(k)为雷达对第i个目标的第j(j＝1，2，…，η)个回波，x_i(k/k)为第i个目标kT时刻的滤波值，λ_ij(k)为权系数，且：Σj=1mλi,j(k)=1,Hi(k)=∂gi[xi(k)]∂xi(k)|xi(k)=xi(k/k-1),]]>h_ij(k)为的j列(j＝1，2，…，r)向量，←表示改写，例如a←b为用b值改写a；(3)、第i个跟踪估计方法为：U_i(k/k)＝[y_1+η y_2+η…y_9+η]，D_i(k/k)＝diag[d_1+η，d_2+η，…，d_9+η]其中：←表示改写，例如c←b为用b值改写c；U_i(k/k)为单位上三角矩阵，D_i(k/k)为对角矩阵；初始的y_j为A^T(k)的第j列向量，A(k)=U‾(k)Gi(k)dT(I-ΩuuT),]]>D~(k)=D‾(k)00Ω,]]>u=11...1,]]>d=Δi,1T(k)Δi,2T(k)...Δi,mT(k);]]>Δ_i，j(k)为第j个候选回波信息向量，Δ_i，j(k)＝z_i，j(k)-g_i[x_i(k/k-1)]。