多传感器数据融合的四轴飞行器姿态角解算

Multi-sensor Data Fusion for Attitude Angle Calculation of Four Axis Aircraft

针对四轴飞行器的姿态角解算方法存在周期长、精度低的问题,提出扩展卡尔曼滤波方法。首先,分析陀螺仪、加速度计、Mahony互补滤波3种姿态角的解算方法;然后,对扩展卡尔曼滤波方法进行公式推导,指出通过迭代可改变卡尔曼增益大小,提高解算精度;最后,通过实验得出,与Mahony互补滤波相比,扩展卡尔曼滤波更可靠。利用扩展卡尔曼滤波方法进行姿态角解算,可提高四轴飞行器的控制精度和稳定性,满足高精度工作场所的需求,具有一定的实践意义。

Aiming at the problem of long period and low accuracy of attitude angle calculation method for four axis aircraft,an extended Kalman filter method is proposed.First of all,the three attitude angle calculation methods of gyroscope,accelerometer and Mahony complementary filter are analyzed;Then,the formula of extended Kalman filtering method is deduced,and it is pointed out that the Kalman gain can be changed by iteration to improve the solution accuracy;Finally,the experiment shows that the extended Kalman filter is more reliable than Mahony complementary filter.The extended Kalman filter method is used to solve the attitude angle,which can improve the control accuracy and stability of the four axis aircraft,and meet the requirements of high-precision workplaces.It has certain practical significance.