基于双旋迫击炮弹平台的改进型Sage-Husa自适应滤波滚转角测量算法

doi:10.3969/j.issn.1000-1093.2018.06.009

兵工学报 ›› 2018, Vol. 39 ›› Issue (6): 1103-1108.doi: 10.3969/j.issn.1000-1093.2018.06.009

基于双旋迫击炮弹平台的改进型Sage-Husa自适应滤波滚转角测量算法

王佳伟^1,2，祁克玉²，杨恺华²，梁轲²，闫杰¹

(1.西北工业大学航天学院, 陕西西安 710072; 2.西安机电信息技术研究所机电动态控制重点实验室, 陕西西安 710065)

收稿日期:2017-10-13 修回日期:2017-10-13 上线日期:2018-07-29
通讯作者: 闫杰(1961—), 男, 教授, 博士生导师 E-mail:jyan@nwpu.edu.cn
作者简介:王佳伟(1984—), 男, 副研究员, 博士研究生。E-mail: wangjiaw0126@163.com
基金资助:
国家自然科学基金项目(U1630127)

Roll Angle Estimation Algorithm with Improved Sage-Husa Adaptive Kalman Filtering Based on Dual-spin Mortar Shell

WANG Jia-wei^1,2, QI Ke-yu², YANG Kai-hua², LIANG Ke², YAN Jie¹

(1.School of Astronautics, Northwestern Polytechnical University, Xi'an 710072, Shaanxi, China；2.Science and Technology on Electromechanical Dynamic Control Laboratory, Xi'an Institute of Electromechanical Information Technology, Xi'an 710065, Shaanxi, China)

Received:2017-10-13 Revised:2017-10-13 Online:2018-07-29

摘要/Abstract

摘要： 针对传统扩展卡尔曼滤波算法无法消除量测噪声、导致二维弹道修正引信滚转角测量误差偏大问题，利用轴向陀螺的实测转速作为系统噪声补偿，提出一种基于双旋迫击炮弹平台的改进型Sage-Husa自适应卡尔曼滤波滚转角测量算法。相对于传统扩展卡尔曼滤波方法，新算法显著降低了滚转角测量误差，提高了滤波器对于弹道升弧段和降弧段滚转角新息改变的自适应性；以高精度三轴转台作为硬件实验验证平台，该算法始终能够保持较高的测量精度和自适应性。研究结果表明：改进后的Sage-Husa自适应卡尔曼滤波滚转角测量算法在仿真验证中的滚转角测量误差均值为0.26°、标准差为0.35°；硬件实验验证中的滚转角测量绝对误差不超过4.2°.

关键词: 双旋迫击炮弹, 二维弹道修正引信, 滚转角测量, Sage-Husa自适应卡尔曼滤波, 转速补偿

Abstract: Traditional extended Kalman filter (EKF) algorithm is unable to eliminate the bigger measured roll angle error caused by irresistible measuring noise. A roll angle estimation algorithm with improved Sage-Husa adaptive Kalman filtering (SHAKF) based on dual-spin mortar shell is proposed, in which the measured rotation speed of gyro is used as compensation for system noise. Compared with traditional EKF algorithm, the proposed algorithm is used to reduce the measuring error of roll angle significantly, and improve the adaptivity of filter to the innovation changing of roll angles in the upward and downward legs of ballistic trajectory. The new proposed algorithm is verified by in-lab testing with MEMS three-axis turntable. The research results indicate that the mean value and standard deviation of measuring errors are 0.26 degs and 0.35 degs, respectively, in simulating verification, and the in-lab testing results show that the estimation error is always less than 4.2 degs in dynamic range changing from 30 r/s to 1 r/s. Key

Key words: dual-spinmortarshell, 2-Dcoursecorrectionfuze, rollangleestimation, sage-husaadaptiveKalmanfiltering, rotationspeedcompensation

中图分类号:

TJ430.2

王佳伟，祁克玉，杨恺华，梁轲，闫杰. 基于双旋迫击炮弹平台的改进型Sage-Husa自适应滤波滚转角测量算法[J]. 兵工学报, 2018, 39(6): 1103-1108.

WANG Jia-wei, QI Ke-yu, YANG Kai-hua, LIANG Ke, YAN Jie. Roll Angle Estimation Algorithm with Improved Sage-Husa Adaptive Kalman Filtering Based on Dual-spin Mortar Shell[J]. Acta Armamentarii, 2018, 39(6): 1103-1108.

参考文献

［1］ Widmayer R S. Terminal trajectory correction capability for standard spinning projectiles[C]∥2nd International Symposium on Ballistics. Daytona, FL，US: International Ballistics Committee, 1976.
[2] Philippe W. Stability analysis for canard guided dual-spin stabilized projectiles[C]∥AIAA Atmospheric Flight Mechanics Conference and Exhibit. Chicago,IL, US: AIAA, 2009.
[3] Philippe W, Friedrich L, Denis B,et al. Wind tunnel tests and open-loop trajectory simulations for a 155 mm canards guided spin stabilized projectile[C]∥AIAA Atmospheric Flight Mechanics Conference and Exhibit. Honolulu, HI, US: AIAA, 2008: 1-17.
[4] Lusia D J. Estimation of the local vertical state for a guided munition shell with an embedded GPS/micro-mechanical inertial navigation system[D]. Cambridge, MA, US: MIT, 1995: 33- 51.
[5] Park H Y, Kim K J, Lee J G, et al. Roll angle estimation for smart munition[C]∥Proceedings of IFAC Symposium on Automatic Control in Aerospace. Toulouse, France: Pleiades Publishing，2007: 6-12.
[6] Lee H S, Kim K J, Park H Y. Roll estimation of a smart munition using a magnetometer based on an unscented Kalman filter[C]∥AIAA Guidance Navigation and Control Conference and Exhibit. Honolulu, HI, US: AIAA, 2008.
[7] Maley J M. Efficient attitude estimation for a spin-stabilized projectile[J]. Journal of Guidance, Control, and Dynamics, 2016, 39(2): 339-350.
[8] 王佳伟，史凯，徐国泰，等. 基于扩展卡尔曼滤波的高转速修正引信滚转角测量方法[J]. 西北工业大学学报，2016，34(6): 938-944.
WANG Jia-wei, SHI Kai, XU Guo-tai, et al. Roll estimation of high rotation speed correction fuze based on extended Kalman filter[J]. Journal of Northwestern Polytechnical University, 2016, 34(6): 938-944.（in Chinese）
[9] Sage A P, Husa G W. Adaptive filtering with unknown prior statistics[C]∥Proceedings of the 10th Joint Automatic Control Conference. Boulder, CO, US: Elsevier，1969: 760-769.

[10] 张常云. 自适应滤波方法研究[J]. 航空学报，1998, 19(7): 96-99.
ZHANG Chang-yun. Approach to adaptive filtering algorithm[J]. Acta Aeronautica et Astronautica Sinica, 1998, 19(7): 96-99. (in Chinese)
[11] 韩子鹏，赵子华，刘世平，等. 弹箭外弹道学[M]. 北京: 北京理工大学出版社，2008: 127-149.
HAN Zi-peng, ZHAO Zi-hua, LIU Shi-ping, et al. Exterior ballistics of projectiles and rockets[M]. Beijing: Beijing Institute of Technology Press, 2008: 127-149. (in Chinese)
[12] Narasimhappa M, Rangababu P, Sabat S L, et al. A modified Sage-Husa adaptive Kalman filter for denoising fiber optic gyroscope signal[C]∥Proceedings of 2012 Annual IEEE. Kochi, India: IEEE Computer Society，2012: 1266-1271.

第39卷第6期
2018 年6月兵工学报ACTA
ARMAMENTARIIVol.39No.6Jun.2018

基于双旋迫击炮弹平台的改进型Sage-Husa自适应滤波滚转角测量算法

Roll Angle Estimation Algorithm with Improved Sage-Husa Adaptive Kalman Filtering Based on Dual-spin Mortar Shell

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 1

编辑推荐

Metrics

本文评价