2. 中国航天科工三院, 北京 100074
旋转弹作为导弹家族中的一员, 具有系统结构简单、成本低、可靠性高等特点。其弹体的自旋运动会带来优势, 能够克服诸如推力偏心、起控点散布、弹体质量分布不均匀等问题[1]。随着导弹小型化和精准化的发展, 旋转弹有着广阔的发展前景。
本文研究的旋转弹所采用导引头为全捷联激光式导引头, 具有体积小、可靠性高、视线角速率不受限制及成本低等优点。国内外学者对导引信息估计方法进行了大量研究:邵真杰等[2]用无迹卡尔曼滤波方法解决了相控阵雷达导引头视线角重构的问题, 验证了无迹卡尔曼滤波方法在视线角估计方面的优越性; Jacques Waldman[3]设计了扩展卡尔曼滤波器, 估计出传统框架式导引头的弹目视线角速率; Dowan等[4]根据弹目视线角关系和坐标空间转换, 推导出弹目视线角速率和弹体姿态角及体视线角速率之间的关系, 从而实现对弹目视线角速率的估计; Wang等[5]重点研究了捷联导引头的2种弹目视线角速率估计方法, 一种是利用微分网络对弹目视线角进行微分以获得弹目视线角速率, 一种是利用卡尔曼滤波器来估计弹目视线角速率, 最后仿真证明了卡尔曼滤波器比网络微分法更具有优势。聂聪等[6]提出了一种基于中央差分卡尔曼滤波(CDKF)的视线角速率估计方法, 该方法充分利用了惯导系统角速率陀螺的信息, 简化了噪声模型, 避免了引入不可测的相对距离和相对速度信息, 比传统的卡尔曼滤波更能精确地估计视线角速率。贾鑫等[7]进行了全捷联导引头解耦技术的研究, 对多种具有代表性的解耦方案进行了分析, 认为卡尔曼滤波法估计视线角速率的效果较好。
全捷联式激光导引头的测量系统与旋转弹的弹体固联, 因而测量系统所测量出来的信息是弹体坐标系下的视线角信息, 不能直接用于旋转弹的控制制导[8]。旋转弹的控制制导需要惯性坐标系下的视线角信息, 因此需要解算出导引头在惯性系下的视线角信息, 并且过滤掉耦合在视线角信息中的噪声信号, 估计出有用的视线角信息。本文采用UKF方法进行了导引信息的估计, 并对比了UKF、EKF和CKF的滤波结果。本研究对于全捷联旋转弹的制导研究具有一定价值。
1 惯性视线角估计模型的建立旋转弹全捷联导引头视线角信号估计会用到以下坐标系:地理坐标系(惯性坐标系)Oxyz, 弹体坐标系Oxbybzb, 视线坐标系Oxsyszs, 体视线坐标系Oxlylzl。用到的角度有俯仰角ϑ, 偏航角ψ, 滚转角γ, 视线方位角qy, 视线高低角qz, 体视线方位角qβ, 体视线高低角qα[9]。坐标系和角度的相关定义如下:
1) 地理坐标系Axyz
坐标系原点A取在导弹发射点上, Ax轴是弹道面与水平面交线, 指向目标方向为正; Ay轴与水平面垂直, 指向上方为正, Az轴与其他两轴构成右手坐标系。在文中, 将地理坐标系作为惯性坐标系使用。
2) 视线坐标系Oxsyszs
坐标系原点O取在导弹的瞬时质心, Oxs轴由导弹质心指向目标的质心; Ozs轴位于地理坐标系确定的水平面内, 与Oxs轴垂直; Oys轴与Oxs轴、Ozs轴互相垂直构成右手直角坐标系。
3) 体视线坐标系OxTyTzT
原点O取在导弹的瞬时质心上, OxT轴由导弹质心指向目标的质心, OyT轴位于弹体坐标系确定的Ox1z1平面内, 与OxT轴垂直。OzT轴与OxT, OyT轴互相垂直并构成右手直角坐标系。
视线方位角qλ:视线坐标系的Oxs轴在水平面内的投影和地理坐标系的Ax轴之间的夹角。
视线高低角qγ:视线坐标系的Oxs轴和水平面之间的夹角。
体视线高低角qα:导弹与目标连线(即图 2中的OxT轴)和弹体坐标系的Ox1z1平面之间的夹角。
体视线方位角qβ:导弹与目标连线在Ox1z1平面内的投影(即图 2中的Ox′轴)和弹体坐标系的Ox1轴之间的夹角。
全捷联激光导引头与旋转弹弹体固联, 其测量的体视线角信息耦合有惯性视线角信息和弹体姿态运动信息, 需要建立相应的解耦模型, 去掉耦合在测量信息中的弹体姿态运动信息[3, 10]。因此, 本文以含有噪声的体视线角信息qα和qβ作为观测量建立观测方程, 以制导需要的惯性视线角qy, qz和惯性视线角速率
将导弹和目标之间的距离定义为r, 则导弹接近目标的速度V可以表示为
(1) |
式中:is, js, ks分别为视线坐标系Oxs轴,Oys轴和Ozs轴上的单位向量。视线坐标系相对地理坐标系的旋转角速度为
(2) |
在视线坐标系中, 有
(3) |
同理, 可以得到
(4) |
(5) |
将导弹和目标的相对速度进行微分后, 可得到弹目相对加速度为
(6) |
如果目标是地面固定目标, 在短周期运动中, 弹目相对运动的速度矢量方向和大小变化不大, 则可以近似认为弹目相对加速度为0, 有
(7) |
令状态方程的状态量为X=
(8) |
目标在体视线坐标系和视线坐标系中的位置坐标均为[r 0 0]T, 根据坐标系之间的转换关系, 可以得到目标在弹体坐标系和地理坐标系中的坐标分别为
(9) |
(10) |
为了便于计算, 令坐标转换矩阵为
(11) |
根据地理坐标系和弹体坐标系之间的转换关系可以得到
(12) |
将(12)式进行解算, 可以得到观测方程为
(13) |
(14) |
全捷联激光导引头测量到的视线角信息中包含外界噪声和干扰信息, 如果将解耦得到的惯性视线角直接用于旋转弹的制导, 会导致导弹的制导精度较差, 甚至可能会使导弹脱靶。为了使导弹能够精准地命中目标, 需要进行滤波处理。从第1小节中的状态方程和观测方程可以看出, 惯性视线角估计模型的系统是非线性系统, 如果采用常规的滤波方法, 无法实现很好地滤波效果。旋转弹的导引信息估计属于一类强非线性条件的物理系统的滤波问题。无迹卡尔曼滤波方法放弃了对非线性系统进行线性化的传统方法, 而是在一步预测方程中, 利用无迹变换来处理均值和协方差的非线性传递, 因此不用忽略高阶项, 相较于EKF方法具有更好的精度。因此, 本文选择UKF作为滤波方法, 过滤掉视线角信息中的噪声和干扰, 估计出有用的视线角信息[11-13]。
2.1 无迹卡尔曼滤波算法的设计对于本文建立的惯性视线角估计模型, 现写出无迹卡尔曼滤波算法设计步骤如下:
1) 选定滤波的初始状态值X0, Y0和协方差矩阵P0。
2) 计算出k-1时刻的sigma样本点集
(15) |
(16) |
(17) |
3) 确定UT变换的权值系数
(18) |
4) 根据算出来的sigma样本点, 计算k时刻的一步预测模型值
(19) |
5) 计算k时刻的一步预测样本点
(20) |
6) 计算方差矩阵P(XZ)k/k-1, P(ZZ)k/k-1
(21) |
(22) |
式中, 有
(23) |
(24) |
7) 计算滤波增益矩阵和滤波值更新
(25) |
式中:α为很小的正数, 取值范围为10-4≤α≤1;β取值和状态量X的分布形式有关, 对于高斯正态分布的状态量, β=2为最优值。
3 仿真验证根据第2小节设计的Kalman滤波器, 采用MATLAB编写程序, 进行仿真验证。本次数学仿真是针对带有目标位置装订误差和导航系统测量误差的情况, 在地理坐标系中, 实际目标的位置为(0, 2.5, 0)m, 目标位置坐标测量误差为(100, 50, 60)m, 因此, 弹载计算机利用导航信息进行制导指令解算时所采用的虚拟目标位置在地理坐标系中的坐标为(100, 52.5, 60)m。信号测量周期为50 ms。为了与UKF形成对比, 本文还进行了EKF和CKF(cubature Kalman filter容积卡尔曼滤波)的仿真, 并分析比较3种滤波方法的结果。仿真结果:
从以上结果可以看出, UKF、EKF和CKF滤波后的视线角信息和真实值非常接近, 可以应用于旋转弹的控制制导, 证明了本文提出的基于无迹卡尔曼滤波的视线角估计算法有效性。
从图 3、图 5和图 6可以看出, EKF在3种方法中的滤波误差最大。UKF相较于目前公认滤波效果较好的CKF方法, UKF在真实值附近的散布更小。在图 4中, CKF滤波值相较于UKF更接近真实值。综合图 3至6来看, UKF的滤波效果最好。
UKF、EKF和CKF滤波产生的滤波值与真实值误差均方根误差如表 1所示。
参数 | UKF | EKF | CKF |
视线高低角/rad | 0.001 9 | 0.003 5 | 0.002 7 |
视线高低角速率/(rad·s-1) | 0.003 5 | 0.004 6 | 0.003 6 |
视线方位角/rad | 0.001 5 | 0.004 9 | 0.002 8 |
视线方位角速率/(rad·s-1) | 0.001 9 | 0.005 8 | 0.002 5 |
计算总时间/s | 6.28 | 0.93 | 6.56 |
从表 1来看, 单纯考虑UKF、EKF和CKF这3种滤波算法的解算误差, 三者对旋转弹的视线角速度估计效果比较接近。使用UKF所获得的滤波值, 其均方根误差均小于表 1中UKF、EKF和CKF滤波产生的滤波值与真实值误差均方根误差EKF和CKF滤波值, UKF算法的误差更小。但是由于UKF需要计算多个样本点, 所消耗的计算资源更大。
4 结论本文介绍了基于无迹卡尔曼滤波的旋转弹视线角信息估计方法, 该方法能够解决视线角信息与弹体姿态信息的耦合问题, 以及旋转弹的自旋所造成的俯仰角和偏航角耦合问题, 并且采用无迹卡尔曼滤波方法估计出了有用的惯性视线角信息。仿真结果表明, 该方法估计出来的惯性视线角信息与真实值接近, 满足制导所需精度。从理论来看, UKF更适于解决非线性系统滤波问题。UKF未采用EKF对非线性函数进行线性化的方法, 以UT变换的方法来处理均值和协方差的非线性传递, 然后用确定性采样的方法来逼近状态的后验概率密度。因此, UKF没有忽略非线性函数的高阶项, 相较于EKF, UKF对于非线性系统的计算精度更高。相较于CKF, 主要区别在于样本点的计算方式不同, 当状态方程的维数较高时, CKF的滤波结果精度高于UKF。而在本文中, 明显可以看到UKF的滤波精度高于CKF, 计算时间也略低于CKF。因此, 在本文旋转弹视线角信息估计方面, UKF更适用。
[1] |
孙婷婷.全捷联制导系统关键技术研究[D].长春: 中国科学院研究生院, 2016 SUN Tingting. Research on Key Technology of Full Strapdown Guidance System[D]. Changchun: Graduate School of Chinese Academy of Sciences, 2016(in Chinese) |
[2] |
邵真杰, 赵明元. 相控阵雷达导引头的惯性视线重构[J]. 现代防御技术, 2015, 43(6): 56-60.
SHAO Zhenjie, ZHAO Mingyuan. Line of Sight Reconstruction for Phased Array Radar Seeker[J]. Modern Defence Technology, 2015, 43(6): 56-60. (in Chinese) DOI:10.3969/j.issn.1009-086x.2015.06.010 |
[3] | WALDMAN Jacques. Line-of-Sight Rate Estimation and Linearizing Control of an Imaging Seeker in a Tactical Missile Guided by Proportional Navigation[J]. IEEE Trans on Control Systems Technology, 2002, 10(4): 556-567. DOI:10.1109/TCST.2002.1014675 |
[4] | KIM Dowan, RYOO Changkyung, KIM Yongho. Guidance and Control for Missiles with a Strapdown Seeker[C]//11th International Conference on Control, Automation and Systems, KINTEX, Gyeonggi-do, Korea, 2011: 969-972 |
[5] | WANG Wei, LIN Defu, XU Ping. Strap-down Seeker LOS Angular Rate Estimation[J]. Infrared and Laser Engineering, 2015, 44(10): 3066-3069. |
[6] |
聂聪, 张科. 全捷联导引头视线角速率估计方法[J]. 计算机仿真, 2017, 34(1): 70-73.
NIE Cong, ZHANG Ke. Line of Sight Angular Rate Estimation Algorithm for Strapdown Seeker[J]. Computer Simulation, 2017, 34(1): 70-73. (in Chinese) DOI:10.3969/j.issn.1006-9348.2017.01.015 |
[7] |
贾鑫, 罗艳伟, 罗丽. 全捷联导引头解耦技术方法[J]. 战术导弹技术, 2013(1): 77-81.
JIA Xin, LUO Yanwei, LUO Li. Decoupling Technology of Full Strapdown Seeker[J]. Tactical Missile Technology, 2013(1): 77-81. (in Chinese) |
[8] |
秀朋朋, 李小兵, 杨瑜哲. 一种弹目视线角的计算方法[J]. 光电工程, 2012, 39: 75-80.
XIU Pengpeng, LI Xiaobing, YANG Yuzhe. A Method of Calculating the Line of Sight[J]. Photoelectric Engineering, 2012, 39(7): 75-80. (in Chinese) DOI:10.3969/j.issn.1003-501X.2012.07.012 |
[9] |
袁亦方.全捷联制导弹药制导控制技术研究[D].北京: 北京理工大学, 2015 YUAN Yifang. Research on Guidance and Control Technology of Full Strapdown Guided Ammunition[D]. Beijing: Beijing Institue of Technology, 2015(in Chinese) |
[10] |
李璟璟.捷联成像导引头视线角速率估计方法研究[D].哈尔滨: 哈尔滨工业大学, 2008 LI Jingjing. Research of LOS Rate Estimation Method for Strap-down Imaging Seeker[D]. Harbin: Harbin Institute of Technology, 2008(in Chinese) |
[11] | SUN T, CHU H, ZHANG B, et al. Line-of-Sight Rate Estimation Based on UKF for Strapdown Seeker[J]. Mathematical Problems in Engineering, 2015(1): 1-14. |
[12] |
秦永元, 张洪钺, 汪叔华. 卡尔曼滤波与组合导航原理[M]. 西安: 西北工业大学出版社, 2012.
QIN Yongyuan, ZHANG Hongyue, WANG Shuhua. Kalman Filtering and Combined Navigation Principle[M]. Xi'an: Northwestern Polytechnical University Press, 2012. (in Chinese) |
[13] | WANG P, ZHANG K. Research on Line-of-Sight Rate Extraction of Strapdown Seeker[C]//Chinese Control Conference, 2014 |
2. The Third Academy of China Aerospace Science&Industry Corporation, Beijing 100074, China