一种联合估计的RAM类目标跟踪算法*

周乾君,吴盘龙,李继民

(南京理工大学自动化学院,江苏 南京 210094)

RAM(Rocket, Artillery and Mortar)类武器是火箭弹、榴弹、迫击炮弹等武器的统称,其威力大，火力猛，机动性能好，射程远，火力覆盖能力强，操作方便,是当前战场主要的火力压制武器,所以，用于防御这类武器的C-RAM系统是新形势下部队防护的迫切需求。RAM类武器作为弹道目标,其实际运动规律与高炮火控系统在解相遇问题的过程中常用的匀速、 匀加速直线目标运动规律不符。因此,有必要研究面向RAM类目标的跟踪与预测算法。

RAM类目标被动段会沿着一个由目标类型以及相应的性能特征事先确定好的飞行路径运动,具有显著的动力学特性,对该类目标建模的主要依据是目标的动力学因素,其中，最典型的参数就是质阻比。对于合作目标,其质阻比已知,可直接根据目标运动方程进行跟踪,并对后续轨迹进行预测。

然而，在实际作战场景下,来袭的RAM类目标往往是非合作目标,质阻比未知,需要对其进行估计。质阻比的估计精度和收敛速度与目标状态的估计相互耦合,当前估计质阻比主要有两种方法。1)利用滤波算法实时估计目标的距离、速度、加速度,根据质阻比物理意义与目标状态及雷达量测的关系推导出质阻比计算公式,该方法在建模过程中不考虑质阻比的影响,往往模型与运动特性不符,估计精度较差。2)基于目标的运动规律,将质阻比与选取的各状态分量一起组成扩维的状态向量,利用非线性滤波实时估计质阻比,该方法充分将目标运动规律与质阻比相结合,估计精度较高。文献[5]将质阻比建模为常数, 采用高斯分布对其进行描述,但因为对质阻比建模不满足其慢时变特性,会影响滤波器的收敛速度和精度。文献[6]采用指数函数在每一个小的时间间隔内对质阻比建模, 该方法计算量大且收敛速度不理想,达不到实际作战场景下对来袭目标快速跟踪的要求。

基于此,本文采用一阶马尔科夫过程对质阻比建模,通过CKF算法对质阻比进行估计,并加入强跟踪思想来应对环境干扰导致的模型失配问题。

1 RAM类目标动力学模型

RAM类目标为典型的弹道目标,主动段结束后,被动段一般保持零攻角。对RAM类目标建模如图1所示,不考虑目标的外形和姿态变化,目标在运动过程中受到重力和空气阻力作用。空气阻力与速度方向相反,重力指向地心。

图1 RAM类目标动力学模型

忽略地球自转,在雷达东北天坐标系下，对RAM类目标被动段的运动状态进行描述,其状态模型可以表示为:

(1)

为了对质阻比进行实时估计,需要对前面建立的模型进行状态扩维作为滤波器的状态模型。常见方法是直接将质阻比作为一个常量来扩维,但这样不能保证质阻比的非负性。为了防止滤波发散,这里采用了式(2)的指数模型:

()=()

(2)

式中，为质阻比初始值,可选取典型RAM类武器的质阻比参数。考虑质阻比变化为慢时变过程,()应为一个慢时变参数,这里使用能够较好地模拟慢时变的一阶马尔科夫过程对()建模,即

(3)

式中,为一阶马尔科夫过程的时间常数,常取为一个较大值,()为零均值高斯白噪声。增广后的RAM类目标状态向量为

()=[(),(),(),(),(),(),()]

(4)

采用四阶龙格-库塔法对状态方程进行离散,最终得到目标的离散非线性系统状态方程为

+1=()+

(5)

2 雷达量测模型

本文以观测雷达为坐标系原点,在球体极坐标系下建立目标量测模型,如图2所示。雷达量测值包括弹道目标到雷达的径向距离、目标方位角、高低角。根据雷达东北天坐标系和雷达极坐标系间的转换关系，建立非线性量测方程:

(6)

考虑雷达量测噪声,系统的量测方程为

=()+

(7)

式中,=[,,]和=[,,]分别为雷达量测和量测噪声,噪声用零均值高斯白噪声表示。

图2 雷达量测模型

3 强跟踪容积卡尔曼滤波(STCKF)

目前主流的非线性滤波算法中,拓展卡尔曼滤波算法(EKF)只适用于弱非线性系统,无迹卡尔曼滤波算法(UKF)面对高维非线性系统存在计算量大、精度低的问题,粒子滤波算法(PF)对环境要求低,但存在粒子退化、计算量大的问题。近年来,Arasaratnam和Haykin提出了基于Cubature变换的容积卡尔曼滤波方法,该方法充分利用球面-相径容积规则选取容积点,利用动态模型进行容积点非线性变换产生新的容积点, 再对新容积点进行加权处理来近似非线性函数传递的后验状态估计均值及协方差矩阵。

CKF适用于任何非线性模型,高维的情况下也能够有效跟踪。算法具体流程如下:

步骤1:初始化。

步骤2:预测。

(8)

(9)

[1]⊂表示维空间的点集,即:

(10)

(11)

状态方程传递容积点:

(12)

计算状态预测均值和预测协方差:

(13)

(14)

步骤3:更新。

(15)

(16)

量测方程传递容积点:

(17)

计算量测预测均值、新息协方差、状态与量测间的互协方差和滤波增益:

(18)

(19)

(20)

(21)

计算时刻后验状态估计均值和协方差:

(22)

(23)

CKF算法实现简单且估计精度高,但当目标受到外界干扰模型失配时,估计精度将会变差，甚至发散。强跟踪滤波器更加强调量测信息的作用,可以更好地应对目标的状态突变,其原理是选择一个适当的时变增益矩阵，使得状态估计残差方差最小,强迫输出残差序列保持相互正交,即:

(24)

(25)

式中，为残差。

在式(19)的新息协方差中引入时变渐消因子,即

(26)

的计算公式为

(27)

4 仿真验证

为验证本文方法,设计地面雷达对RAM类目标跟踪的仿真场景。以某口径的火箭弹为例,根据炮弹三自由度运动方程,在雷达站坐标系下生成目标的真实轨迹,发射高低角为45°,落点在雷达附近。雷达扫描周期为20 ms,测距精度为 10 m,测角精度为 1 mrad(包括高低角和方位角)。节选目标飞行中段及末段25 s轨迹作为跟踪对象,并加入10 m/s的横风模拟外界环境的干扰,使轨迹产生横偏,运动轨迹如图3所示。

图3 RAM类目标运动轨迹

为验证所建立模型的优势,采用三种方法对比仿真,分别对有风和无风状态下的目标进行跟踪。

1)把质阻比建模为常数的CKF方法,状态噪声协方差为

=diag([01,01,01,01,01,01,30])

2)基于改进模型的CKF方法,马尔科夫模型的时间常数设为=1×10,状态噪声协方差为

=diag([01,01,01,01,01,01,001])

3)基于改进模型的STCKF方法,参数设置与方法2一致。

本文共进行100次蒙特卡洛仿真,质阻比初值均为=4 000 kg/m。 无风条件下的跟踪结果如图4、5、6和表1所示。从图4可看出,利用传统模型估计质阻比可以收敛至真值附近,但收敛速度缓慢。相比之下,本文模型收敛速度大幅提高,比普通方法快了40%,且精度较好。因为基于一阶马尔科夫过程的质阻比模型可以更好地表征RAM类目标质阻比的慢时变过程,从而加快了滤波的收敛速度。从图6和图7可以看出,目标状态估计的收敛速度和精度也有了明显提高,精度提高了30%。但STCKF方法和CKF方法在精度上并没有太大的区别,因为无风条件下本文建立的模型与目标较匹配,引入强跟踪算法并不会对跟踪效果有明显的提升。

表1 无风下位置与速度均方根误差平均值

图4 无风下质阻比估计对比

图5 无风下位置估计均方误差对比

图6 无风下速度估计均方误差对比

有风条件下的跟踪结果如图7、8、9和表2所示,从图7可以明显看出,因为存在横风的扰动,模型失配,基于改进模型的CKF方法对质阻比的估计效果会明显变差。对比之下,引入了强跟踪的STCKF算法对质阻比的估计依然能够收敛到真值,位置和速度跟踪误差对比普通CKF方法也有一定改善,因为强跟踪算法更加强调量测信息的作用,对系统模型不准确具有一定的鲁棒性,增加了估计的稳定性。

图7 有风下质阻比估计对比

图8 有风下位置估计均方误差对比

图9 有风下速度估计均方误差对比

表2 有风下位置与速度均方根误差平均值

5 结束语

本文以RAM类目标为对象,根据其运动特性，提出了一种状态与质阻比联合估计的目标跟踪方法。考虑传统建模中将质阻比视为常量，与质阻比的慢时变过程不符,本文采用一阶马尔科夫过程对质阻比建模。为提高对弹道类目标跟踪的可靠性,引入强跟踪容积卡尔曼滤波器。经仿真验证,该模型相比于常用的常数模型,跟踪的收敛速度提高了40%,精度提高了30%, 强跟踪滤波器的引入也提高了算法的鲁棒性。