一种基于对偶四元数的惯性/GPS组合导航方法

摘要

本发明公开了一种基于对偶四元数的惯性/GPS组合导航方法，属于飞行器组合导航技术领域。该方法首先建立陀螺和加速度计误差模型，并将陀螺及加速度计误差扩展为系统状态变量，构建基于对偶四元数的惯性/GPS组合卡尔曼滤波状态方程；随后，结合GPS的量测信息及对偶四元数捷联惯导算法的计算值，构建基于对偶四元数的惯性/GPS组合卡尔曼滤波量测方程；最后，对系统状态方程和量测方程进行离散化处理，采用卡尔曼滤波进行闭环估计并对惯导算法中的推力速度对偶四元数、引力速度对偶四元数、位置对偶四元数进行修正，从而得到载体的导航信息。本方法能够有效利用GPS的输出信息对惯导解算误差进行修正，提高惯性导航系统性能，适用于工程应用。