Filtering algorithm for micro-electro-mechanical gyroscope of rocket with lateral thrust control

The attitude of rocket oscillates in high frequency when it is controlled by lateral thrust, and its micro-electro-mechanical systems (MEMS) gyroscope will be affected. Most of current filtering algorithms assume that the roket attitude changes slowly in a short interval, and it will generate unacceptable modeling error. With aerodynamic analysis, it can be seen that the attitude oscillation is a natural frequency damping oscillation and the natural frequency and damp ratio can be estimated in advance. Thus, a novel filtering algorithm is proposed, which applies the interacting multiple models (IMM) with swing Markov model to describe the uncertain roket attitude motions. Furthermore, the dynamic adjustment mechanism of state transferring probability matrix with the lateral thrust control command can be introduced. Finally, the numerical simulation indicates that IMM filtering algorithm with swing Markov model can accurately trace the attitude vibration.