摘要:
本发明公开了一种基于对偶四元数的惯性/GPS组合导航方法,属于飞行器组合导航技术领域。该方法首先建立陀螺和加速度计误差模型,并将陀螺及加速度计误差扩展为系统状态变量,构建基于对偶四元数的惯性/GPS组合卡尔曼滤波状态方程;随后,结合GPS的量测信息及对偶四元数捷联惯导算法的计算值,构建基于对偶四元数的惯性/GPS组合卡尔曼滤波量测方程;最后,对系统状态方程和量测方程进行离散化处理,采用卡尔曼滤波进行闭环估计,并对惯导算法中的推力速度对偶四元数、引力速度对偶四元数、位置对偶四元数进行修正,从而得到载体的导航信息。
本方法能够有效利用GPS的输出信息对惯导解算误差进行修正,提高惯性导航系统性能,适用于工程应用。
| 专利名称 | 一种基于对偶四元数的惯性/GPS组合导航方法 | ||
|---|---|---|---|
| 专利状态 | - | 专利号(申请号) | CN201710178159.6 |
| 申请号 | - | 专利申请日期 | 2017-03-23 |
| 专利授权日期 | 2017-05-31 | 专利权届满日 | - |
| 专利所属地 | 中国 | 专利类型 | 发明专利 |
| 发明人 | 闵艳玲;熊智;邢丽;刘建业;王融;殷德全;许建新;施丽娟;景羿铭;万众;鲍雪;黄欣 | ||
| 权利人 | - | ||
| 专利摘要 | 本发明公开了一种基于对偶四元数的惯性/GPS组合导航方法,属于飞行器组合导航技术领域。该方法首先建立陀螺和加速度计误差模型,并将陀螺及加速度计误差扩展为系统状态变量,构建基于对偶四元数的惯性/GPS组合卡尔曼滤波状态方程;随后,结合GPS的量测信息及对偶四元数捷联惯导算法的计算值,构建基于对偶四元数的惯性/GPS组合卡尔曼滤波量测方程;最后,对系统状态方程和量测方程进行离散化处理,采用卡尔曼滤波进行闭环估计并对惯导算法中的推力速度对偶四元数、引力速度对偶四元数、位置对偶四元数进行修正,从而得到载体的导航信息。本方法能够有效利用GPS的输出信息对惯导解算误差进行修正,提高惯性导航系统性能,适用于工程应用。 | ||