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

doi:10.3969/j.issn.1000-1093.2018.06.009

Abstract

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

CLC Number:

TJ430.2

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.

References

［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

[1]	LI Xiaoxiong, ZHANG Shuning, ZHAO Huichang, CHEN Si. Identification of Fuzzy Small-sample Terrain Targets Based on 1DC-CGAN and Wavelet Energy Features [J]. Acta Armamentarii, 2022, 43(10): 2545-2553.
[2]	MA Mengxin， LI Rong, NIU Lanjie. Evaluation Index of Disturbance Superposition Degree in Multi-layer Penetration Acceleration Signal [J]. Acta Armamentarii, 2022, 43(1): 20-28.
[3]	LI Changsheng， DONG Wenjie， CAO Juan， ZHU Chuanjun， ZHANG He. A Dual-directional Information Transmission Method for Fuze Wireless Setting System Based on Nonlinear Parity-time-symmetry [J]. Acta Armamentarii, 2021, 42(12): 2565-2574.
[4]	JI Tong'an， LOU Wenzhong， FU Shenghua， WANG Jinkui， LIU Weitong. Dynamic Rendezvous Concentration Detection Method for FAE Secondary Detonation Fuze and Blast Cloud [J]. Acta Armamentarii, 2021, 42(11): 2327-2332.
[5]	YAN Amin， PI Aiguo， WANG Jian， HUANG Fenglei， WANG Xiaofeng. The Method for Determining the Threaded Connection Parameters of Projectile-fuze System Based on Thin-layer Element Model [J]. Acta Armamentarii, 2021, 42(4): 743-754.
[6]	ZHAO Xin, JI Yongxiang, LIU Shefeng, CHEN Zhong, NING Xiaolei. Data Processing of Test of Fuze Arming Distance Measured Using Langlie Method Based on Bayesian Method [J]. Acta Armamentarii, 2021, 42(1): 26-32.
[7]	HUANG Shaling， ZHU Hongzhi， CHENG Xiangli， XIE Yubin. Adaptive Threshold Setting Method for Layer-count in Penetration Fuse [J]. Acta Armamentarii, 2020, 41(9): 1762-1771.
[8]	SHI Kai， ZHANG Qian, LIU Mabao. Analysis of Spin Rate and Correction ability of Two-dimensional Trajectory Correction Fuze for 155mm Fixed-canard Dual-spinProjectiles [J]. Acta Armamentarii, 2019, 40(8): 1587-1595.
[9]	CAO Juan, LI Chang-sheng, ZHANG He, MIAO Dong-hui. Influence of Metal Environment on Parameters of Fuze Wireless Setting System Based on Magnetic Resonance Coupling [J]. Acta Armamentarii, 2018, 39(6): 1041-1048.
[10]	XU Xiao, GAO Shi-qiao, NIU Shao-hua, SHEN Li, LIU Hai-peng, OU Zhuo-cheng. Dynamic Analysis of Projectile-borne Electronic Devices under Impact Loading [J]. Acta Armamentarii, 2017, 38(7): 1289-1300.
[11]	LIAO Xiang, LI Hao-jie, ZHANG He. Design Method of Energy Isolation System for Fuze Setting via Primer [J]. Acta Armamentarii, 2017, 38(4): 673-678.
[12]	ZHAO Wei， ZHANG Hao-jun， WANG Song-jie. Design of High Isolation and Compact Transmitting/receiving Antennas for Fuze [J]. Acta Armamentarii, 2016, 37(11): 2157-2162.
[13]	XU Xiao， JIN Lei， HUANG Shaling， GAO Shiqiao， ZHANG Husheng. Transmission Characteristics of Impact Load of Flying Debris at Epoxy Resin/printed Circuit Board/epoxy Resin Interfaces [J]. Acta Armamentarii, 2020, 41(9): 1817-1825.
[14]	ZHANG Cong, LU Junhua , YUE Mingkai. Design and Simulation of Bionic Composite Damping Structure for Imaging Fuze [J]. Acta Armamentarii, 0, (): 0-.