[发明专利]三角平方根分解的多目标跟踪方法

摘要

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

主权项

1.一种三角平方根分解的多目标跟踪方法，其特征在于包括以下步骤：(1)、定义N个目标跟踪中第i个目标的离散化模型为x_i(k+1)＝Φ(k+1，k)x_i(k)+Λω_i(k)，其中：为状态向量，(x，y，z)为目标在地面参考直角坐标系下的位置坐标，ω_i(k)表示方差为Q_i(k)的过程噪声向量，Φ(k+1，k)＝Φ＝diag[Φ₁，Φ₁，Φ₁]为状态转移矩阵，Λ=∫KT(k+1)TΦ(k+1,τ)Γ(τ)dτ=Λ1000Λ1000Λ1,]]>Γ(t)为系数矩阵，Γ=Γ1000Γ1000Γ1,]]>Γ₁＝[001]^T，Φ1=1T12T201T001,]]>Λ1=16T312T2TT,]]>T为采样周期；第i个目标的时间更新为：x_i(k+1/k)＝Φx_i(k/k)a=(yl)TylClj=0j=1,2,...,l-1aj=l[(1/a)(yl)T]yjj=l+1,l+2,...nyj=yj-Clj[yl/a]j=l+1,...,nl=1,2,...,n]]>其中：n＝9，x_i(k+1/k)为第i个目标对(k+1)T时刻的一步预测值，为对应的一步预测误差的方差阵，y_j为Y^T(k)的第j列向量，S_i(k+1/k)为上三角矩阵，C_lj为S_i(k+1/k)的第l行第j列元素；初始条件为x_i(0/0)和S_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)测量噪声；计算a=(y‾l)Ty‾lC‾lj=0j=1,2,...,l-1aj=l[(1/a)(y‾l)T]y‾jj=l+1,l+2,...ny‾j=y‾j-C‾lj[y‾l/a]j=l+1,...,nl=1,2,...,n]]>Gi(k+1)=S‾-T(k+1)S‾-1(k+1)Ri-1(k+1)]]>xi(k+1/k+1)=xi(k+1/k)+Gi(k+1){Σj=1mλij(k+1)zij(k+1)-gi[xi(k+1/k)]}]]>其中：n＝9，为的第j列向量，Y‾(k)=Si-T(k+1/k)HiT(k+1)Ri12(k+1),]]>为上三角矩阵，为的第l行第j列元素；z_ij(k+1)为雷达对第i个目标的第j(j＝1，2，…，m)个回波，x_i(k+1/k+1)为第i个目标(k+1)T时刻的滤波值，λ_ij(k+1)为权系数，且：Σj=1mλi,j(k+1)=1,]]>Hi(k+1)=∂gi[xi(k+1)]∂xi(k+1)|xi(k+1)=xi(k+1/k);]]>(3)、第i个跟踪估计方法为：a=(bl)TblSlj=0j=1,2,...,l-1aj=l[(1/a)(bl)T]bjj=l+1,l+2,...nbj=bj-slj[bl/a]j=l+1,...,nl=1,2,...,n]]>其中：n＝9，b_j为Y^T(k+1)的第j列向量，S_ij为S_i(k+1/k+1)的第l行第j列元素，S_i(k+1/k+1)为上三角矩阵，为第i个目标(k+1)T时刻估计误差的方差阵；u=11···1,]]>d=Δi,1T(k+1)Δi,2T(k+1)···Δi,mT(k+1);]]>Δ_i，j(k+1)为第j个候选回波信息向量，Δ_i，j(k+1)＝z_i，j(k+1`)-g_i[x_i(k+1/k)]。