一种基于MEMS传感器的全局渐进稳定的姿态估计算法

Aiming at the requirement of attitude information module with high precision, small size and low power consumption for the control of miniature UAV, a practical attitude estimation algorithm based on the micro-electro-mechanical sensor is proposed in this paper, which realizes the accurate estimation of the attitude of the UAV under the condition of low acceleration. A low-cost MEMS gyroscope, accelerometer, and magnetometer are used in the system. The Euler angle is obtained by the state observer method based on Direction Cosine Matrix (DCM) which can be got by fusing the sensor data. Firstly, based on the basic idea of TRIAD algorithm, a method to determine the attitude rotation matrix by accelerometer and magnetometric measurement is proposed. Compared with the traditional method, this method does not have to calculate the inverse of the matrix. Secondly, a state observer is intended to estimate the attitude of the system. The state observer doesn't have to observe the bias of the gyroscope, but still ensures the convergence of the Euler angle. Finally, the simulation based on the actual sampling data of the MEMS sensor shows that the output of the state observer designed in this paper still has high accuracy and good dynamic characteristics under the condition of gyroscope noise and bias.