基于多普勒频率变化率和方位的机动目标无源跟踪算法
2018-08-11吕昆峰
王 骏,吕昆峰,刘 梅
(1. 中国电子科技集团公司第二十九研究所,四川 成都 610036;2. 哈尔滨工业大学电子与信息工程学院,黑龙江 哈尔滨 150001)
随着科技发展和电子战技术的不断升级,无源定位技术越发受到人们的重视,观测平台利用目标自身辐射信号或者所反射的其他辐射信号对目标进行定位的技术有了长足的发展[1]。目前单站无源定位跟踪比较成熟的方法是纯方位法,但该方法要取得良好观测效果,对观测平台的运动形式有一定的限制,目标的高速机动将增加定位跟踪难度[2],而且角度测量与目标运动参数的非线性关系使得纯方位目标跟踪问题具有较大的难度[3]。
对于具有频率测量能力的雷达系统而言,由于多普勒频率变化率中包含距离信息,因此通过引入多普勒频率变化率这一测量,将其和方位角联合观测,在一定条件下能较大提高对目标的跟踪精度。此外,对于机动目标而言,由于其运动状态变化,使用基本的跟踪方法容易丢失目标,因此应当使用适应机动目标的跟踪方法[4]。经典的机动目标跟踪方法有机动检测类跟踪算法以及自适应跟踪算法,其中基于交互式多模型的机动目标跟踪方法具有较好的实用水平。本文提出了一种对方位测量和多普勒变化率测量进行联合,利用交互式多模型方法(IMM)和无迹卡尔曼滤波器(UKF)的机动目标跟踪算法,结果表明,该算法对于大机动目标的跟踪效果明显优于纯方位跟踪算法,且采取的交互式多模型方法具有良好的自适应性,算法鲁棒性较强。
1 方位和多普勒频率变化率的联合定位可观测性分析
对于方位和多普勒联合定位问题,根据质点运动学原理,观测平台和目标的相对位置关系如图1,平台在tk时刻获取的一组测量值可表示为:
(1)
由式(1),解得:
(2)
的取值,因此可分为以下四种情景:
综上所述,测量增加一维多普勒频率变化率信息后,并非一定可以改善目标的可观测性。只有当两者观测性均良好时才可以提高目标可观测性、改善跟踪效果。若多普勒频率变化率不可观测,则退化为仅方位角跟踪,属于弱观测,若方位角不可观测,则无法对目标进行跟踪。
2 基于IMM和UKF的机动目标跟踪算法
2.1 算法框图
跟踪定位算法流程图如图2所示。
算法步骤：
步骤1利用初始一段时间内目标的测量数据进行初始定位得到目标的初始位置;
步骤2各个模型滤波器利用各模型概率、测量值以及经交互作用所得上一时刻状态进行各自的状态更新以及模型概率计算;
步骤3利用新一时刻各个模型概率进行模型概率更新;
步骤4利用模型概率及各个滤波器滤波结果进行状态估计混合,输出目标航迹。
2.2 机动目标初始定位
假设对目标进行初始定位时,目标未发生机动,则通过式(3)计算其在一段时间内的定位结果,并将各个定位点向最新时刻进行平滑,取平滑结果的均值为初始定位结果。
假设初始定位时目标不发生机动,ar(tk)为零,则由式(1)可反推出目标的坐标[xe(tk),ye(tk)]T如下:
(3)
其中T表示数据率对应周期;n表示参与运算的测量值之间间隔n帧,k表示第k帧,k=n+1,n+2,…N-1,tk表示第k帧的时间,N表示最新帧。λ表示目标辐射源信号波长。
得到定位后,利用方位角变化率得到目标速度,并将定位结果平滑到新的第N帧:
(4)
(5)
(6)
其中,i=n+1,n+2,…N-1。
2.3 机动目标滤波初始化
滤波初始化问题是运用无迹卡尔曼滤波器的一个重要前提条件,只有进行了初始化,才可能利用上述滤波器对目标进行跟踪,目标初始协方差阵、测量噪声协方差阵以及过程噪声协方差阵的确定方法。
对于二维空间中的目标跟踪,系统的状态向量可描述为[5]:
X(k+1)=Φ(k)X(k)+G(k)V(k)
(7)
雷达的观测方程可表示为:
Z(k)=H(k)X(k)+W(k)
(8)
这里,Z(k)∈Rn是雷达在k时间内的观测向量,H(k)是测量矩阵,观测噪声W(k)∈Rn是具有零均值和正定协方差矩阵R(k)的高斯分布测量噪声向量。
1) 目标跟踪噪声协方差阵的初始化
雷达测量噪声协方差可表示为:
(9)
系统的过程噪声协方差矩阵为:
Q=E[(G(k)V(k))(G(k)V(k))T]=
(10)
2) 目标状态协方差阵的初始化
(11)
利用该径向距离与目标的角度测量值θk可反推出目标的位置坐标,如下:
(12)
因此在k时刻,雷达测量噪声在直角坐标系下的协方差表示为
(13)
其中,r21(k)=r12(k):
(14)
2.4 无迹卡尔曼滤波器
由于方位角和多普勒频率变化率信息是对目标状态的不完全描述,用以进行目标跟踪是一个非线性滤波过程,因此需要采用非线性滤波器来实现。无迹卡尔曼滤波器(Unscented Kalman Filter,UKF)不需要对非线性系统进行线性化,并且其跟踪精度要高于EKF[6]。 UKF对状态向量的概率密度函数进行近似化,表现为一系列选取好的采样点。这些采样点完全体现了高斯密度的真实均值和协方差。当这些点经过非线性系统的传递后,得到的后验均值和协方差都能够精确到二阶,因此UKF对系统的非线性强度不敏感[7]。由于不需要对非线性系统进行线性化,并可以很容易地应用于非线性系统的状态估计。
X(k+1)=f(X(k))+v(k)
Z(k+1)=h(X(k+1))+w(k+1)
(15)
有如下公式:
(16)
1) 根据无迹变换计算X(k)的采样点ξi(k|k)和其对应的权值wi。
2) 根据状态方程,可以得到ξi(k|k)采样点的一步预测:
ξi(k+1|k)=f(ξi(k|k))
(17)
(18)
(19)
3) 预测状态ξi(k+1|k)到预测量测点ζi(k+1|k)表达式如下:
ζi(k+1|k)=h(ξi(k+1|k))
(20)
4) 预测量测相应的协方差为:
(21)
测量方差矩阵:
(22)
状态向量与测量值的协方差矩阵:
(23)
5) 计算UKF增益,更新状态向量和方差
(24)
(25)
P(k+1/k+1)=P(k+1/k)-K(k+1)PzzK(k+1)T
(26)
2.5 交互式多模型机动目标跟踪
高速机动目标在运动过程中,不仅速度快而且往往进行机动,交互式多模型使用多个不同的运动模型分别匹配目标的不同运动状态;不同模型间的转移概率是一个马尔可夫链,在同一时刻各个模型均起作用且依照模型概率进行滤波结果的更新,以实现对机动目标的自适应跟踪,且其跟踪机动目标无需机动检测,跟踪无时间滞后[8]。
交互式多模型算法包含多个对应不同模型的滤波器,一个模型概率估计器,一个交互式作用器和一个估计混合器[9]。具有N个模型的交互式多模型算法从k-1时刻到k时刻的递推过程如下:
1) 状态估计的交互作用
设模型i跳转到模型j的转移概率为Ptij:
(27)
(28)
式中
(29)
(30)
2) 模型修正
3) 模型可能性计算
(31)
式中
(32)
4) 模型概率更新
模型j的概率更新为
(33)
其中
(34)
5) 模型输出
(35)
(36)
3 仿真分析
实验1:增加多普勒频率变化率后对跟踪性能的改善
场景设置:仿真中观测平台起始位于坐标(0 km,0 km)处以550 km/h速度沿-60°方向进行匀速直线运动,方位角测量误差取为0.1°,多普勒频率变化率测量误差为1 Hz/s,数据率为1Hz。目标的运动起点在(100 km,100 km)处,运动状态设置为以300 m/s的速度匀速沿135°方向运动,跟踪中分别采用纯方位UKF跟踪和多普勒频率变化率联合方位纯UKF跟踪，如图3所示。
由实验一可以看到,相比于纯方位跟踪,增加一维多普勒频率变化率后的跟踪效果明显更好,说明增加多普勒频率变化率后跟踪性能得到提高。
实验2:验证采用交互式多模型算法后对机动目标跟踪性能的改善。
场景设置:仿真中观测平台起始位于坐标(0 km,0 km)处以550 km/h速度沿-60°方向进行匀速直线运动,方位角测量误差取为0.1°,多普勒频率变化率测量误差为1 Hz/s,数据率为1 Hz。目标的运动起点在(100 km,100 km)处,运动状态设置为先以300 m/s的速度匀速沿135°方向运动一段时间,随后进行转弯,转弯后匀速直线运动。采用多普勒频率变化率联合方位角UKF和多普勒频率变化率联合方位角IMM-UKF分别进行跟踪。同时对比纯方位跟踪的成熟算法,分析本文提出算法的稳定性。仿真结果如图4所示:
由实验二可以看到，在初始的匀速运动阶段，使用多普勒频率变化率和方位角联合跟踪的UKF及IMM_UKF算法均具有良好的跟踪效果；而在目标发生机动后，使用IMM_UKF算法的跟踪结果抖动很小且能迅速收敛，而未使用交互式多模型(IMM)的跟踪结果则明显发散，跟踪效果甚至差于仅使用方位角的UKF跟踪结果。说明基于交互式多模型的多普勒频率变化率联合方位角机动目标跟踪算法能有效提升无源定位跟踪系统对机动目标的跟踪性能。
4 结束语
针对无源探测系统中机动目标跟踪的技术难点，本文提出了一种采用UKF滤波器和交互式多模型方法，利用目标方位和多普勒频率变化率对机动目标进行跟踪，对目标的可观测性改善进行了分析和仿真，证明了增加多普勒频率变化率后，目标的可观测性不一定得到改善，只有在方位角观测性好且多普勒频率变化率观测性也好时，才能改善目标可观测性。通过仿真实验，验证了IMM-UKF算法对机动目标跟踪的性能。经过分析实验结果可以看出，以上方法对于无源探测系统具有很好地适应性，能够较好的完成基于方位和多普勒频率变化率的机动目标航迹形成。
