A Novel Initial Alignment Based on the HMM/Steady State KALMAN Filter

In allusion to low accurary and poor stability of the initial alginment based on the acceleration sensor, the HMM (Hidden Marco Model) / steady state Kalman filter is designed to solve the problem above. C8051F340 is used to sample the acceleration data of the MEMS acceleration sensor Model1221, then the digital low-pass filter is used to filter the acceleration data. The steady state Kalman filter based on the second order HMM model. The initial alignment algorithm outputs the angle value. The experiments demonstrate that the the HMM / steady state Kalman filter is more stable and more precise than the traditional algorithm.