吕梅柏,赵小锋,刘广哲
(1.西北工业大学,陕西 西安 710072;2.航天飞行动力学国防重点实验室,陕西 西安 710072;3.海军驻西安导弹设备军事代表室,陕西 西安 710065)
随着现代空战中目标机动性的增强及机动方式的增多,对导弹末制导阶段的目标准确跟踪提出了严峻的挑战。当目标机动较大时会大大降低导弹的拦截精度,需要对目标运动参数进行滤波,选择合适的目标跟踪模型和滤波估计算法是提高目标跟踪精度的有效途径之一[1]。
在传统的匀速(CV)、匀加速(CA)及Singer等模型中,选取的状态变量无法对机动转弯目标进行准确描述,而机动转弯模型(CT)通过引入转弯角速度,较好地解决了坐标耦合问题[2]。由于空中目标的机动具有很大不确定性,采用单一模型无法完整描述空中大机动目标的运动。交互式多模型算法(IMM)通过马尔可夫转移矩阵实现多个模型之间的切换,是目前解决未知机动问题的一种有效方法[3]。
在导弹末制导阶段,由导引头测量到的目标信息是在球坐标系中进行描述的,导致系统具有非线性[4-5]。常用的非线性滤波算法有扩展卡尔曼滤波算法(EKF)及无迹卡尔曼滤波算法(UKF)等。EKF算法在线性化的过程中会引入模型误差,在系统的非线性较强时容易发散[6],UKF在使用时需调节三个参数,且采样点数目的增加导致计算量增大,不利于进行实时计算。容积卡尔曼滤波算法(CKF)采用一组容积点集计算随机变量在非线性变化后的均值和协方差,具有更优的非线性逼近性能和滤波精度,且实现简单[7]。
原始的IMM算法采用了EKF方法,部分文献将UKF与CKF方法应用于IMM算法中,取得了较好的结果[8-10]。本文采用IMM模型及CKF算法,在导弹末制导阶段对大机动目标进行跟踪,结果验证了该方法对空中大机动目标进行跟踪的有效性,且在运行时间上优于IMM-UKF算法,适合用于实时计算。
空中目标在正常巡航状态下,一般为匀速直线运动,可以采用(CV)模型进行描述,而当目标发现来袭导弹后,往往会采取机动进行逃逸,此时可以采用机动转弯(CT)模型进行描述。假设目标在Oxy平面内做匀速等过载转弯运动[11],即
(1)
式中:vt为目标运动速度;ω为转弯角速度。
Xk=Φk,k-1Xk-1+ΓWk-1,
(2)
(3)
CT模型中,
(4)
(5)
设(xt,yt,zt),(xm,ym,zm)分别为目标和导弹在惯性坐标系下任意时刻的坐标,则导弹与目标的相对运动方程为[12]
(6)
目标视线旋转角速度为
(7)
(8)
采用广义比例导引律,则导弹的制导控制方程为
(9)
建立导引头观测方程
Zk=h(Xk)+Vk,
(10)
式中:观测向量为Zk=(φ,ε,r)T;Vk是均值为0,协方差阵为R的高斯白噪声向量;h(·)为非线性函数,且
(11)
CKF基于三阶球面径向容积准则,通过一组等权值的容积点来近似计算非线性系统中的概率积分。采用文献[13]中的简化CKF算法,计算步骤如下:
(1) 时间更新
状态预测:
(12)
预测误差协方差矩阵:
Pk|k-1=ΦPk-1ΦT+ΓQk-1ΓT.
(13)
(2) 量测更新
权值:
(14)
容积点估计:
(15)
容积点传播:
zl,k=h(xl,k).
(16)
量测预测值:
(17)
新息方差矩阵:
(18)
协方差矩阵:
(19)
最优增益:
(20)
状态更新:
(21)
误差协方差矩阵更新:
(22)
基于CV,CT 2种运动模型设计交互式多模型,设计步骤如下[14-15]:
(1) 输入交互
计算联合概率矩阵:
(23)
将每一列相加,得到在k+1时刻模型j的预测概率:
(24)
则输入交互概率为
(25)
根据输入交互概率对当前状态和估计方差进行交互计算:
(26)
(27)
(2) 滤波更新
(3) 模型概率更新
模型j的似然函数为
Λj(k+1)=
(28)
模型j的更新概率为
(29)
(4) 模型输出
状态估计为
(30)
误差协方差阵为
(31)
为了验证IMM模型及CKF算法对于导弹末制导阶段对大机动目标跟踪的准确性,采取如下仿真计算流程:
(1) 初始化导弹及目标位置、速度、加速度等运动参数,初始化滤波器参数;
(2) 根据目标运动方程计算目标当前时刻的真实运动参数;
(3) 根据上一时刻的目标运动参数估计值及导弹实际运动参数计算导弹加速度,并利用导弹运动方程计算导弹当前时刻的运动参数;
(4) 根据导引头观测方程产生带有噪声的导引头观测数据;
(5) 采用IMM-CKF算法估计目标当前时刻的运动参数;
(6) 判断弹目距离是否小于给定值,若是,结束仿真,否则,返回第(2)步。
仿真参数设置如下:
目标初始位置为(8 000,2 000,8 000),初始速度为(80,20,40),机动转弯角速度ω=0.5 rad/s,在0~12 s内作匀速直线运动,在12~20 s内进行机动转弯,在20~23 s内作匀速直线运动,在23 s以后进行机动转弯。
导弹初始位置位于原点,速度为500 m/s,初始弹道倾角θ=0,初始弹道偏角ψV=0,比例导引系数N取为3。
仿真步长T=0.02 s,过程噪声协方差阵为Qw=diag(12,12,12),导引头测量噪声协方差阵Rr=diag(0.012,0.012,1002),滤波器初始化参数为
(32)
模型转移概率矩阵为
(33)
采用蒙特卡罗仿真方法进行多次仿真,用均方根误差衡量目标跟踪偏差,位置误差及速度误差分别为
(34)
在Matlab中进行仿真,仿真结果如图1~6所示。
由图1中导弹与目标运动轨迹图可以看出,尽管目标进行了多次大机动,最终导弹仍然能够命中目标,由图2目标真实运动轨迹与目标轨迹估计值可以看出,IMM-CKF方法能够克服初始误差准确跟踪目标,在目标匀速直线运动与机动转弯阶段能够实现平滑切换,使滤波稳定收敛。
由图3与图4的导弹法向加速度曲线可以看出,导弹法向加速度随着目标运动模式的转换而发生改变,且由于滤波误差的存在有一定程度的抖动。
分别采用CKF与UKF方法滤波,进行100次蒙特卡罗仿真,图5与图6分别为目标位置估计均方根误差与目标速度估计均方根误差。
由估计误差结果可以看出,在目标进行运动模式切换时,会产生较大的滤波误差,此时IMM算法会进行运动模型切换,逐渐稳定跟踪目标。由UKF与CKF方法的对比可以看出,2种方法在估计精度上相差不大,表1为100次仿真2种方法的用时对比,可以看出CKF方法比UKF方法所用时间更短,适合用于实时计算。
表1 IMM-CKF与IMM-UKF仿真时间对比
本文对空中大机动目标的运动进行了分析建模,同时建立了导弹制导模型及导引头测量模型。结合IMM算法与简化CKF滤波算法在导弹末制导阶段对目标进行跟踪,通过仿真验证了估计方法的有效性。
由蒙特卡罗仿真结果得出CKF与UKF 2种滤波方法精度相当,且CKF方法在时间上更有优势,IMM算法中对多个模型进行滤波处理的过程可以并行实现,因此本文采用的IMM-CFK非常适合用于弹载计算机,具有较好的工程参考价值。
参考文献:
[1] 张晓宇,陈营营,李英兰.蛇形机动目标视线角滤波算法研究[J].应用科技,2015,42(6):36-39.
ZHANG Xiao-yu,CHEN Ying-ying,LI Ying-lan.Study of LOS Angle Filtering Algorithm for Sinusoidally Maneuvering Targets [J].Applied Science and Technology,2015,42(6):36-39.
[2] 张亮亮,周峰,徐彤.新的“S-蛇形”机动目标模型及跟踪方法研究[J].电光与控制,2012,19(9):13-16.
ZHANG Liang-liang,ZHOU Feng,XU Tong.A New Model of the “S-Maneuver”Target and a Tracking Method [J].Electronics Optics and Control,2012,19(9):13-16.
[3] 封普文,黄长强,曹林平,等.马尔可夫矩阵修正IMM跟踪算法[J].系统工程与电子技术,2013,35(11):2269-2274.
FENG Pu-wen,HUANG Chang-qiang,CAO Lin-ping,et al.Research on Adaptive Markov Matrix IMM Tracking Algorithm [J].Systems Engineering and Electronics,2013,35(11):2269-2274.
[4] 侯静.雷达/红外双模导引头数据融合跟踪算法研究[D].西安:西北工业大学,2010.
HOU Jing.Study on Data Fusion Tracking Algorithm of Radar/Infrared Dual Mode Seeker [D].Xi′an:Northwestern Polytechnical University,2010.
[5] 张继光.红外/毫米波双模导引头数据融合平台的研究与设计[D].西安:西北工业大学,2010.
ZHANG Ji-guang.Study and Design of Infrared/Millimeter Wave Dual Mode Seeker Data Fusion Platform[D].Xi′an:Northwestern Polytechnical University,2010.
[6] 王泠,刘超.基于UKF联合IMM的目标跟踪技术研究[J].机械制造,2013,51(3):12-17.
WANG Ling,LIU Chao.Research on Target Tracing Technology Based on UKF and IMM [J].Machinery,2013,51(3):12-17.
[7] 郭彦,于艳婷,胡献君.非线性滤波方法及其性能比较[J].计算机与数字工程,2016,44(11):2113-2117.
GUO Yan,YU Yan-ting,HU Xian-jun.Nonlinear Filtering Methods and Performances Comparison [J].Computer and Digital Engineering,2016,44(11):2113-2117.
[8] 陈海,单甘霖.基于IMMCKF的机动目标跟踪算法[J].电光与控制,2011,18(10):1-5.
CHEN Hai,SHAN Gan-lin.Maneuvering Target Tracking Based on IMMCKF Algorithm[J].Electronics Optics and Control,2011,18(10):1-5.
[9] 许登荣,程水英,包守亮.基于IMM-CKF的弹道再入目标跟踪研究[J].弹箭与制导学报,2017,37(1):13-18.
XU Deng-rong,CHENG Shui-ying,BAO Shou-liang.Research on Ballistic Reentry Target Tracking Based on IMM-CKF [J].Journal of Projectiles,Rockets,Missiles and Guidance,2017,37(1):13-18.
[10] 彭亮.机动目标跟踪算法的研究[D].西安:西北工业大学,2007.
PENG Liang.Research on Maneuvering Target Tracking Algorithm [D].Xi′an:Northwestern Polytechnical University,2007.
[11] 魏洁英,卢志刚,郑伟,等.蛇形机动目标建模[J].火力与指挥控制,2012,37(sl):22-24.
WEI Jie-ying,LU Zhi-gang,ZHENG Wei,et al.Modeling of the Serpents Maneurer Targets [J].Fire Control and Command Control,2012,37(sl):22-24.
[12] 曲晓燕,张林,范庚.基于Matlab/Simulink的空空导弹攻击区仿真[J].弹箭与制导学报,2011,31(5):51-54.
QU Xiao-yan,ZHANG Lin,FAN Geng.The Simulation of Attack Area for Air-to-Air Missile Based on Matlab/Simulink [J].Journal of Projectiles,Rockets,Missiles and Guidance,2011,31(5):51-54.
[13] 蔡宗平,牛创,戴定成.基于简化CKF的IMM算法[J].现代防御技术,2015,43(6):99-103.
CAI Zong-ping,NIU Chuang,DAI Ding-cheng.Interacting Multiple Model Algorithm Based on Simplified Cubature Kalman Filter [J].Modern Defence Technology,2015,43(6):99-103.
[14] 金学波.Kalman滤波器理论与应用[M].北京:科学出版社,2016:132-136.
JIN Xue-bo.Kalman Filter Theory and Applications [M].Beijing:Science Press,2016:132-136.
[15] 韩崇昭,朱洪艳,段战胜.多源信息融合[M].2版.北京:清华大学出版社,2010:60-62.
HAN Chong-zhao,ZHU Hong-yan,DUAN Zhan-sheng.Multi-Source Information Fusion[M].2nd ed.Beijing:Tsinghua University Press,2010:60-62.