[1]丁国强,张铎,熊明,等.SINS姿态估计的HoMM-UKF模型算法[J].郑州大学学报(工学版),2017,38(04):39-45.[doi:10.13705/j.issn.1671-6833.2017.01.017]
　Ding GuoqiangZhang DuoXiong MingZhou Weidong.The HoMM-UKF Algorithm of SINS’ Attitude Estimation Model[J].Journal of Zhengzhou University (Engineering Science),2017,38(04):39-45.[doi:10.13705/j.issn.1671-6833.2017.01.017]
点击复制

SINS姿态估计的HoMM-UKF模型算法()
分享到：

《郑州大学学报(工学版)》[ISSN:1671-6833/CN:41-1339/T]

卷:
38
期数:
2017年04期
页码:
39-45
栏目:
出版日期:
2017-07-18

文章信息/Info

Title:
The HoMM-UKF Algorithm of SINS’ Attitude Estimation Model
作者:
丁国强1; 张铎1; 熊明1; 周卫东2
1.郑州轻工业学院电气信息工程学院,河南郑州,450002;2.哈尔滨工程大学自动化学院,黑龙江哈尔滨,150001
Author(s):
Ding Guoqiang1Zhang Duo1Xiong Ming1Zhou Weidong2
1. School of Electrical and Information Engineering, Zhengzhou Institute of Light Industry, Zhengzhou, Henan, 450002; 2. School of Automation, Harbin Engineering University, Harbin, Heilongjiang, 150001
关键词:
Keywords:
DOI:
10.13705/j.issn.1671-6833.2017.01.017
文献标志码:
A
摘要:
针对舰船捷联惯性导航系统姿态控制计算精度要求,提出一种高阶矩匹配UKF (high-order moment matching UKF,HoMM-UKF)的SINS系统四元数模型姿态估计算法.在UKF迭代递推计算过程中利用高阶矩匹配方法计算系统状态参数的预测采样点集及其权值的概率分布平均偏态和峰值,使其精确逼近状态参数最优估计.采用四元数姿态建模方法构建新型SINS状态变量与噪声向量相关的姿态方程模型,利用伪观测向量构建观测噪声与四元数相关的观测方程模型,设计系统噪声方差分离计算算法开展系统噪声方差计算,引入拉格朗日乘子算法计算四元数估计均值,最后利用SINS四元数姿态估计模型对HoMM-UKF算法开展仿真试验研究.通过UKF算法、CDKF算法与HoMM-UKF算法对比,验证了HoMM-UKF算法计算精度高,并且算法计算量负担较小,计算效率较高.
Abstract:
In order to improve the precision requirement about the attitude control of the strap-down inertial navigation system,the high order moment matching UKF (Higher-order Moment Matching UKF,HoMMUKF) algorithm was proposed,that is to estimate the SINS’ attitude parameters of based on its quaternion error model.In the recursive calculation process,for accurately approximating computational purposes,it uses high order moment matching method to calculate the average skewness value and peak value of the predicted sampling points set and their weights of the system state parameters in the view of the probability distribution.Making use of attitude quaternion method,then onlinear quaternion error model was constructed,in which model the systemnoise vector depends on system state vector,meanwhile construct its measure equation whose measurement noise vector depends on quaternion measurement vector by pseudo observation vector method was constructed,the weighted average of estimated quaternion with Lagrangian operator was calculated,the system noise variance calculation with the system noise separation algorithm was carried out,and finallyconstruct the SINS’ attitude estimation HoMM-UKF algorithms simulation on SINS attitude experiment platform was designed.It can be seen that HoMM-UKF algorithm’s calculation accuracy is higher than others and has better numerical stability,comparison of the UKF,and CDKF algorithms,and so the HoMM-UKF algorithm’s feasibility and calculation accuracy is verified.
更新日期/Last Update: