基于径向加速度的RA-Singer-EKF机动目标跟踪算法

摘要

本发明公开了一种基于径向加速度的RA-Singer-EKF机动目标跟踪算法，属于雷达机动目标跟踪领域。本发明的方法可快速准确地提供机动目标的径向加速度和径向速度信息，有效提高雷达对机动目标的跟踪性能。本发明的方法包括以下步骤：(一)对雷达接收信号进行采样，利用匹配追踪(OMP)方法得到目标径向加速度和径向速度；(二)在数据处理阶段将径向加速度和径向速度进行坐标转换并引入量测方程和状态方程；(三)采用Singer模型和扩展卡尔曼滤波(EKF)算法实现机动目标跟踪。本发明能够精确实时地反映目标的机动情况，提高了目标跟踪精度，改善了速度和加速度估计精度，工程实现容易，具有较强的工程应用价值和推广前景。

主权项

1.一种基于径向加速度的RA-Singer-EKF机动目标跟踪方法，是指在信号处理阶段采用正交匹配追踪(OMP)思想对目标径向加速度和径向速度进行提取，在数据处理阶段将径向加速度和径向速度估计值通过坐标转换引入量测方程和和状态方程中，并采用Singer模型和扩展卡尔曼滤波(EKF)方法实现机动目标的精确跟踪，其特征在于包括以下步骤： 步骤1：将雷达接收机接收到的线性调频信号s(t)通过采样器以采样间隔T_s进行采样，变为离散信号s(nT_s)，其中n表示采样点序号；将s(nT_s)送入雷达信号处理计算机； 在雷达信号处理计算机中执行以下步骤： 步骤2：初始化(设置分解参数) T设为雷达的脉冲宽度； λ为雷达波长； f_s为采样频率； T_s＝1/f_s为采样间隔； f_u设为LFM信号的初始频率； k_v设为LFM信号的调频率； G((U×V)×N))设为过完备原子库，U×V为原子库中原子的个数，N＝T/f_s； λ²设为判断OMP分解是否完成的相干比阈值； 步骤3：形成过完备原子库 (1)根据LFM信号回波s(t)的特点，建立原子g_r＝ex_p[j2π(f_un+k_vn²/2N)]，r＝1，2，…，N； (2)设定搜索精度和范围，假设搜索范围f_u的取值为f_u∈[0，U]△f_u，u＝1，2，…，U，U为起始频率的搜索个数，△f_u为多普勒单元，搜索范围Δk_v的取值为k_v∈[0，V]Δk_v，Δk_v为调频率单元，v＝1，2，…，V，V为调频率的搜索个数，构造的过完备原子库G为(U×V)×N的矩阵： G＝[g₁，g₂，…，g_N]^T； 步骤4：正交匹配追踪(OMP) 本发明采用正交匹配追踪(OMP)方法对信号进行参数提取，和标准匹配追踪(MP)方法相比，该方法在信号参数估计时精度更高，并且稀疏分解收敛速度更快；首先将过完备原子库中的原子与信号进行匹配程度比较，选择与信号最匹配的一组基g_r，将所选的原子利用 Grant-Schmidt正交化方法进行正交化处理，然后将信号在这些正交原子构成的空间下进行分解，使其满足 |<s，g_r(f_u，k_v)>|＝sup|<s，g_r>| 因此，信号可以分解为在最佳原子上的分量和残余两部分，即 s＝<s，g_r>g_r+R¹s 其中，R¹s是用最佳原子对原信号进行最佳匹配后的残余；然后从原子库中将最匹配的这组基删掉，接下来对最佳匹配后的残余可以不断进行上面同样的分解过程，即： Rⁱs＝<Rⁱs，g_ri>g_ri+Rⁱ⁺¹s 其中g_ri满足： <Rⁱs，g_ri>＝sup<Rⁱs，g_r> 经过i次迭代后能量衰减程度△Rⁱ⁺¹为：ΔRⁱ⁺¹＝‖Rⁱs‖²-‖Rⁱ⁺¹s‖²＝ω²‖Rⁱs‖²，其中，‖Rⁱs‖²和‖Rⁱ⁺¹s‖²分别是信号s的i阶和i+1阶残余能量；ω²＝λ²(Rⁱs)表示信号衰减的速率；当λ²(Rⁱs)≥λ²时，停止分解；假设经过L步分解后停止分解，信号被分解为： 用少量的原子L(相对于信号长度N而言，L《N)表示信号的主要成分，即： 步骤5：径向加速度和速度的确定 (1)经过上述对信号s(t)的OMP分解，计算出原子库中匹配的原子，得到信号的稀疏解能量图i∈(0，U×V)；(2)在i∈(0，U×V)范围搜索最大的峰值； (3)找到最大峰值的坐标Am(i)，并在原子库G中查找此坐标的位置的g_r(f_u，k_v)，就可以得到目标的初始频率f_u和调频率k_v，i＝1，2，…，N，最后根据以下公式得到机动目标的径向加速度和速度： α＝kλ/2，v＝f_dλ/2 步骤6：将得到的径向加速度和径向速度估计值送到雷达数据处理计算机，进行极(球)坐标系到直角坐标系的转换 根据速度与状态向量几何关系图可以得到径向速度和直角坐标系下X轴方向速度v_x和Y轴方向速度v_y的关系： 同理可得径向加速度和直角坐标系下X轴方向速度α_x和Y轴方向速度α_y的关系： 步骤7：建立Singer模型 将机动加速度作为零均值时间相关色噪声建模。该模型中设机动加速度的概率密度函数在[-A_max，A_max]上近似服从零均值均匀分布，其时间相关函数为指数衰减形式： 式中，α是在区间(t，t+τ)内决定目标机动特性参数的待定参数；α为机动频率，即机动时间常数的倒数，其取值与具体机动状态有关；为目标的加速度方差，可由α(t)概率密度模型求取。对时间相关函数R(τ)应用Wiener-Kolmogorov白化程序后，机动加速度可用输入为白噪声的一阶时间相关模型来表征，即 式中u(t)表示均值为零、方差为1的高斯白噪声；ω₁(t)表示均值为零、方差为的高斯白噪声。步骤8：确定量测方程： 设状态向量X表示为 X＝[x v_x α_x y v_y α_y]^T    (3) 式中x、v_x、α_x和_y、v_y、α_y和分别表示直角坐标系下X轴和Y轴的位置、速度和加速度。 设量测向量Z表示为： 式中和分别表示极-直坐标的无偏转换后直角坐标系下X轴和Y轴的位置；z_rv、z_ea表示信号处理阶段得到的径向速度和径向加速度估计值，设其量测误差均为零均值高斯白噪声且其协方差为由(1)、(2)、(3)、(4)式可得状态向量到量测向量的方程： Z(k+1|k)＝H[X(k+1|k)]+V(K+1)                      (5) 式中H[X(k+1|k)]表示量测矩阵，V(K+1)表示方差为R(k+1)的量测噪声。 其中 雅克比矩阵为： 式中 步骤9：确定状态方程 假设连续时间状态方程可以表示为 式中状态向量X(t)＝[x(t)v_x(t)v_y(t)_y(t)α_x(t)α_y(t)]^T分别表示目标X轴、Y轴方向位置、速度加速度；设采样周期为T′_s，对连续时刻的状态方程式进行离散化处理，可得到下列离散状态方程： 式中X(k|k)＝[x(k|k)v_x(k|k)α_x(k|k)y(k|k)v_y(k|k)α_y(k|k)]^T， Q(k)＝E[w_j(k)·w_j^T(k)]； 步骤10：EKF算法： 采用量测方程(5)和状态方程(6)的EKF算法流程为： 式中P(k+1|k)＝A(k)P(k)A^T(k)+Q(k) Z(k+1|k)＝H(k+1)X(k+1|k) In(k+1)＝Z(k+1)-Z(k+1|k) X(k+1|k+1)＝X(k+1|k)+Kg(k+1)In(k+1) P(k+1|k+1)＝[I-Kg(k+1)H_X(k+1)]P(k+1|k)[I+Kg(k+1)H_X(k+1)]^T-Kg(k+1)R(k+1)Kg^T(k+1) 。