基于误差状态卡尔曼滤波的多旋翼飞行器组合导航方法

本发明公开了一种基于误差状态卡尔曼滤波的多旋翼飞行器组合导航方法。该方法包括：首先，建立传感器的测量模型，推导四元数形式的导航方程，并对该方程进行线性化处理得到误差状态方程；然后，基于GPS、磁力计和加速度计的测量信息，建立用于卡尔曼滤波估计的测量方程；最后，结合惯性?GPS松组合模式，采用误差状态卡尔曼滤波器ESKF对误差状态进行最优估计，并实现对导航状态的校正。本发明使用四元数时计算量较小，而且能够消除惯性导航系统存在的累计误差，实现高精度导航。