The precise measurement of rocket flight attitude angle is a prerequisite for rocket guidance control and achieving precise strikes.Aiming at the characteristics of small size,high impact,and harsh measurement environment of rocket fuze position,a combined geomagnetic/gyroscope algorithm model for measuring rocket flight attitude is proposed.By analyzing the functional relationship between the three axes of geomagnetic sensors and the attitude angle of rocket flight,a geomagnetic/gyroscope combined measurement model is established by combining it with a gyroscope attitude measurement model.A high-order square root volume Kalman filter(CMN-HSR-CKF)algorithm is designed based on the derived geomagnetic/gyroscope combined measurement model,combined with the working conditions where rocket flight interference can cause colored noise in the combined measurement system.Simulation experiments and live fire flight data show that the proposed algorithm can effectively suppress cumulative errors,and the roll angle measurement error in flight experiments can be controlled within±2.5°,which is 34.2％and 30.5％less than EKF and SR-CKF algorithms.
维普
万方数据
