摘要

An attitude algorithm is used by a given magnetic and inertial measurement unit (MIMU) for weight fusion of the outputs of gyroscope and the outputs of the subunit constructed by accelerometer and magnetometer for attitude calculation of a rigid body. It has been proved that the weight assigned to the outputs of gyroscope determines the overall performances of attitude algorithm. A new weight adaptive regulation method based on Kalman filter and hidden Markov model is proposed, and then a new attitude algorithm is constructed by the integration of that method with recursive quaternion estimation algorithm. The authors' attitude algorithm is compared with some other related attitude algorithms in their experiments. With the outputs of the sensors in MTi as the inputs of the new attitude algorithm, the maximum attitude estimation errors in response to three-dimensional random movements and the changes of their amplitudes are 2.85 degrees and 6.82 degrees, respectively, and the Allan variance of attitude drift in response to motionless conditions is 2.1x10(-4)degrees. Other attitude algorithms cannot simultaneously achieve similar dynamic and similar static performances comparing to their attitude algorithm. The results validate the overall performance improvement of their attitude algorithm.