一种基于卡尔曼滤波的四旋翼无人机姿态数据融合的方法

摘要

一种基于卡尔曼滤波的四旋翼无人机姿态数据融合的方法，涉及组合导航中多传感器数据融合领域，尤其涉及一种基于卡尔曼滤波的四旋翼无人机姿态数据融合的改进方法。本发明是要解决现有的卡尔曼滤波在四旋翼无人机姿态运算过程中运算量太大而无法实时获取姿态数据的问题。本发明方法通过对卡尔曼滤波方程组进行改进，即对当前状态预测方程、当前状态误差协方差预测方程、当前最优姿态角方程、卡尔曼增益Kg(k)方程和当前最优姿态角方程的协方差方程进行改进，实现部分数据离线计算，大大减少飞控板处理器的计算量，从而满足四旋翼无人机姿态数据实时性要求和数据精度要求。本发明可应用于组合导航中多传感器数据融合技术领域。