Roll estimation algorithm based on extended Kalman filter with spin compensation

According to the rotation features of 2-D trajectory correction fuze of dual-spin stabilized projectile, a method with extended Kalman filter is introduced to solve the roll estimation of correction fuze by using a spin compensation algorithm. Firstly, based on a certain kind of commissioned dual-spin mortar shell, two different simulating rotation circumstances are separately discussed using a spin compensation EKF algorithm. Simulation results show that the estimated absolute error under high spin rate condition is less than 5°, and the absolute error under low rotation circumstance is less than 2.5°. Furthermore, the spin compensation EKF algorithm is also verified in lab test with MEMS three-axis turntable, and the result shows that the absolute error is less than 4° in dynamic varying range from 30r/s to 1r/s.