樊 垚,费玮玮,杨洪康,刘海旻
(中国船舶工业系统工程研究院,北京 100094)
由于被动探测器仅能获得目标的方位信息而不能检测目标的距离,利用单平台单基阵测量定位时,在本舰不进行机动的情况下,仅使用该探测平台的方位角测量值,目标运动状态不可观测[1-3]。被动声呐跟踪水中目标是典型的目标运动分析(TMA)问题,探测平台机动是目标运动可观测的必要条件,通过非线性滤波方法以及探测平台机动提高纯方位TMA 问题中目标状态可观测性。目前常用的目标跟踪定位方法有直角坐标系下的扩展卡尔曼滤波、伪线性滤波及修正极坐标下的扩展卡尔曼滤波等[4-5]。随着军事技术的不断发展,敌我双方的对抗性显著提高,在双方平台对抗博弈的条件下,被跟踪目标会通过采取必要的机动提高生存能力,因此,机动目标运动要素估计的研究成为军事上的迫切需求。
本文在修正极坐标系下研究了单平台被动目标跟踪定位问题,提出一种距离参数化滤波器设计方法,降低滤波器初始参数对目标运动状态估计的不利影响,提高估计算法收敛速度和精度。给出基于目标运动状态滤波器的目标机动检测算法,实现对水中机动逃逸目标运动要素迅速、准确的估计,解决水中机动目标检测与跟踪问题。
在不同的坐标系中目标运动估计滤波系统方程有不同的特点,本文采用修正极坐标将系统状态变量分成了可观测和不可观测两部分。目标与探测平台的几何关系如图1 所示。
图1 目标与探测平台的几何关系Fig. 1 Relative geometric graph of target and detective platform
直角坐标系的状态向量定义为:
其中, vx, vy, rx, ry分别为目标在x,y 方向的相对速度和相对距离。
修正极坐标系下的系统状态向量定义为:
令目标和探测平台在x,y 方向上的加速度分别为atx, aty, aox, aoy, 相对加速度为 ax, ay,则
令
得
令
可得到修正极坐标系下的状态方程为:
由于在修正极坐标系中,目标方位角 β(t)是状态向量的一个分量,因此,在修正极坐标系中,纯方位TMA 问题的测量方程为:
其中, n(t)为目标方位角测量噪声。
修正极坐标系下目标运动要素解算表达式如下:
其中: vx, vy为 目标在x,y 方向的绝对速度; θ为目标的航向角; v为目标速度。
采用扩展Kalman 滤波(EKF)算法求解纯方位TMA 问题,该算法采用递推方式,计算量较小,能够对系统进行实时定位,且估计精度较高,利于实际工程的应用。纯方位TMA 问题中系统状态方程(3)和测量方程(4)为连续形式,适当选取t=kT、to=(k-1)T,可将连续方程离散化,其中,T为采样周期。采用式(8)所示标准EKF 滤波算法对探测平台与目标相对运动状态进行实时估计。
其中:y(0|0)为状态向量初始给定值;P(0|0)为给定的y(0|0)误差协方差阵;σ2为测量量的误差方差。
在纯方位TMA 问题中,探测平台与目标相对距离是不可观测变量,当目标与探测平台相对距离先验分布信息比较模糊时,直接使用EKF 滤波算法容易导致状态协方差矩阵过早收敛,从而使得滤波发散。距离参数化(RP)方法将初始距离按照相对距离估计值的变异系数分成若干个独立区间,每个独立区间使用独立的EKF 滤波器进行状态估计计算,初始时刻每个滤波器将赋予均匀的权值。当系统获得下一时刻观测值时,系统的状态向量和协方差矩阵要升级一次,与此同时,在RPEKF 中各个独立区间的权重也需要重新计算并归一化处理。假定目标方位角的估计值和测量值服从高斯分布,利用贝叶斯理论,给出子区间权重递推计算公式,如式(9)。如果子区间内目标方位角的估计值与测量值有较大的差别,那么对应的子区间权重就会降低。反之,权重就会升高。
式中:Wnk为第n个区间在k时刻的权重;为第n个区间方位角预测值;θm为方位角测量值;σ2=+为第n 个区间的方位角方差值;为第n 个区间的方位角预测值误差方差值;为方位角测量值误差方差值。
纯方位TMA 问题针对静止目标或匀速直线运动目标开展研究,当目标出现机动时,目标运动要素估计算法无法实现对目标的无偏估计,系统状态无法收敛至真实状态值。为克服此缺陷,设计机动检测环节,在检测到目标机动时重新初始化目标运动状态滤波器。
由于RPEKF 是几个独立EKF 共同工作的滤波系统,所以其目标机动检测算法应在各EKF 目标机动检测算法的基础上进行修正,算法中使用系统状态综合值和系统协方差矩阵综合值实现目标机动检测,表达式如下:
其中:
式中: Wik为k 时刻,第i 个独立滤波器的权重值;yi(k|k-1)为k 时刻,第i 个独立滤波器的状态估计值;Pi(k|k-1)为k 时刻,第i 个独立滤波器的状态误差协方差矩阵;若 Uk大于给定阈值 µk则认为目标机动,将状态向量 yi(k|k) 和状态误差协方差矩阵 Pi(k|k)进行重置,并且暂停机动检测环节 S 个周期, S为滞后步长。
4.1.1 仿真初始条件
探测平台与目标相对距离34000m,目标舷角30°。
本文中探测平台采用“Z”字形机动方式,机动过程由匀速直线运动与匀速圆周运动交替进行。其中,探测平台移动速度为5m/s,转弯角速率为1°s。该运动方式由3 个参数决定,分别是一周期内匀速直线运动的时间Tline为400s,一周期内匀速圆周运动的时间Tcircle为90s,机动运动的瞄准线夹角Φaim为β0。这里,β0为初始时刻目标方位角。
探测平台测量量为叠加了白噪声的目标方位角,噪声均值为0,标准差为1°。
4.1.2 滤波器初始参数
探测平台采用被动声呐测量目标方位角,由于对目标初始位置缺乏先验信息,这里给出目标初始相对距离分布区间为[10000m,35000m],采用RPEKF 滤波器对目标运动要素进行估计。
根据距离分布区间大小决定了EKF 滤波器数量,本文选择滤波器个数为4。假定每个独立距离分布区间中距离误差服从均匀分布,对应于4 组EKF 滤波器的初始距离可以分为4 个独立区间[10000m,14000m],[14000m,19600m],[19600m,27400m],[27400m,35 000 m],每个独立区间都对应一个独立的EKF 滤波器,每个独立区间分配的权重为0.25。
4 组独立的EKF 滤波器初值如下:
式中:β(0)为初始时刻目标方位角测量值; Rn为第n 个区间的中心值;σθ˙n为第n 个区间状态变量 θ˙的标准差,取为1 5/Rn;σR˙/Rn为第n 个区间状态变量 R˙/R的标准差,取为15/Rn;σθ为目标方位角测量误差标准差,取为1°;σ1/Rn为第n 个区间状态变量1 /R的标准差,取为。
4.1.3 仿真分析
定义目标运动要素估计误差百分比如式(15) 所示,估计误差比例反映了目标运动要素估计值的相对误差水平。
基于前述仿真条件,采用如式(3)所示EKF 滤波器状态方程,如式(4)所示测量方程,如式(8)所示滤波方程,如式(9)所示各EKF 滤波器权重升级方程,进行数字仿真分析。图2 为探测平台与目标相对运动轨迹。图3~图5 为目标距离、速度、航向估计误差百分比。
图2 本舰-目标相对运动轨迹Fig. 2 Trajectory of target and detective platform
图3 目标距离估计误差百分比Fig. 3 Evaluated error percentage of target distance
图4 目标速度估计误差百分比Fig. 4 Evaluated error percentage of target velocity
图6~图9 为RPEKF 滤波器中4 组独立的EKF 滤波器权值变化曲线。
由图可知,目标距离,目标速度和目标航向均能收敛于真值。由于初始相对距离为34 000 m 在第4 区间内,第1、2、3 区间权重值变为0,第4 区间权重值为1,表明本文中提出的距离参数化方法是有效的。
4.2.1 仿真初始条件
在实际水上目标机动场景中,最常见的运动形式是分段匀速直线运动,目标机动方式描述如下:
图6 第1 区间权值变化曲线Fig. 6 Weight coefficient curve of the first section
图7 第2 区间权值变化曲线Fig. 7 Weight coefficient curve of the second section
图8 第3 区间权值变化曲线Fig. 8 Weight coefficient curve of the third section
图9 第4 区间权值变化曲线Fig. 9 Weight coefficient curve of the fourth section
其中:cmnew为目标机动后的航向;βTm为本艇相对目标的方位;qTm为本艇相对目标的舷角,目标机动时刻设为1 500 s。
检测目标机动后,本舰机动形式如4.1 节所述,轨迹参数Tline为600 s,Tcircle为90 s,Φaim为βreset。其中,βreset为检测到目标机动时刻目标方位角。
其余仿真初始条件同4.1.3 节相关参数。
4.2.2 滤波器初始参数
当检测到目标机动后,滤波器重置,其初始状态如下:
式中:βreset为滤波器重置时刻目标方位角测量值;Rn_reset为滤波器重置后第n 个区间的中心值;σθ˙n_reset为滤波器重置后第n 个区间状态变量 θ˙的标准差,取为1 5/Rn_reset;为第n 个区间状态变量R˙/R的标准差,取为15/Rn_reset; σθ为目标方位角测量量标准差,取为1°;σ1/Rn_reset为第n 个区间状态变量1/R 的标准差,取为σRn_reset/。
其余滤波器初始参数同4.1.2 节相关参数。
4.2.3 仿真分析
基于前述仿真条件,采用如式(3)所示EKF 滤波器状态方程,如式(4)所示测量方程,如(8)所示滤波方程,如式(9)所示各EKF 滤波器权重升级方程,如式(10)~式(12)所示目标机动检测算法,进行数字仿真分析。图10 为探测平台与目标相对运动轨迹,图11~图13 为目标距离、速度、航向估计误差百分比。
图10 本舰-目标相对运动轨迹Fig. 10 Trajectory of target and detective platform
图11 目标距离估计误差百分比Fig. 11 Evaluated error percentage of target distance
图12 目标速度估计误差百分比Fig. 12 Evaluated error percentage of target velocity
图13 目标航向估计误差百分比Fig. 13 Evaluated error percentage of target heading angle
可知,该条件下检测到目标机动的时刻为1 721 s,目标机动检测算法可行。滤波器重置后,目标距离估计值于2 475 s 收敛于10%误差范围内;目标速度估计值于3 004 s 收敛于10%误差范围内;目标航向估计值于2 071 s 收敛于10°误差范围内。
1)针对纯方位TMA 问题,本文给出非线性RPEKF滤波方法,通过引入多组EKF 滤波器和滤波器权重调节,能够有效降低滤波器性能对于初值偏差的敏感性,改善其目标运动状态量的收敛特性。
2)针对水面目标常用的分段匀速直线机动形式,本文提出的基于RPEKF 滤波器的目标机动检测方法能够有效检测目标机动,并通过重置滤波器参数抑制目标运动状态滤波发散。