A fuzzy adaptive complementary filter for attitude estimation based on norm judgment

Abstract

Unmanned aerial vehicle (UAV) has great application prospect because of its capability of three-dimensional space operation. The reliability of attitude and heading reference system (AHRS) for UAV attitude estimation is crucial for the application of UAV. When a UAV is subjected to unknown electromagnetic interference and force interference in flight, its attitude detection system can suffer from reduced accuracy or even failure. In this paper, a fuzzy adaptive complementary filter (CF) for attitude estimation based on norm judgment is proposed to solve the problem that the sensor is easily disturbed by the complex flight environment and the fixed filter parameters are difficult to obtain the UAV attitude accurately under different flight states. Firstly, the correction model of the gyroscope, which includes four filter parameters, namely accelerometer weight, magnetometer weight, proportional gain P and integral gain I, is established. Secondly, the influence of the four parameters on the estimation accuracy is analyzed. Finally, the adaptive adjustment rules are designed to adjust the filter parameters online and thus achieve the accurate and reliable measurement of UAV attitude. The feasibility of the proposed algorithm is verified through static, dynamic and interference experiments with the specially designed AHRS test platform. And the results show that the attitude estimation algorithm designed in this paper can ensure the high accuracy of the system in both steady state and high-speed rotation, shield the pitch and roll angles from the acceleration of motion, and keep the yaw angle from the external magnetic field.