SINS姿态估计的HoMM-UKF模型算法

摘要：

针对舰船捷联惯性导航系统姿态控制计算精度要求,提出一种高阶矩匹配UKF (high-order moment matching UKF,HoMM-UKF)的SINS系统四元数模型姿态估计算法.在UKF迭代递推计算过程中利用高阶矩匹配方法计算系统状态参数的预测采样点集及其权值的概率分布平均偏态和峰值,使其精确逼近状态参数最优估计.采用四元数姿态建模方法构建新型SINS状态变量与噪声向量相关的姿态方程模型,利用伪观测向量构建观测噪声与四元数相关的观测方程模型,设计系统噪声方差分离计算算法开展系统噪声方差计算,引入拉格朗日乘子算法计算四元数估计均值,最后利用SINS四元数姿态估计模型对HoMM-UKF算法开展仿真试验研究.通过UKF算法、CDKF算法与HoMM-UKF算法对比,验证了HoMM-UKF算法计算精度高,并且算法计算量负担较小,计算效率较高.

关键词：捷联惯性导航、姿态估计、高阶矩匹配、HoMM-UKF算法、Lagrangian乘子

所属期刊栏目：38

分类号：TP271(自动化技术及设备)

资助基金：国家自然科学基金资助项目U1204603

在线出版日期：2017-10-20（万方平台首次上网日期，不代表论文的发表时间）

页数：共7页

页码：39-45