s
###
DOI:
飞控与探测:2021,(5):27-33
本文二维码信息
码上扫一扫!
基于多矢量定姿的动基座最优化对准算法
(1.微惯性仪表与先进导航技术教育部重点实验室 东南大学 仪器科学与工程学院;2.上海航天控制技术研究所)
Optimal Alignment Algorithm for Moving Base Based on Multi Vector Attitude Determination
LIU Wenqian1,2,CHENG Xianghong1,2,CAO Peng3,DING Peng1,2
(1.Key Laboratory of Micro-Inertial Instrument and Advanced Navigation Technology, Ministry of Education, Southeast University;2.School of Instrument Science & Engineering, Southeast University 3.;3.Shanghai Aerospace Control Technology Institute)
摘要
相似文献
参考文献
本文已被:浏览 43次   下载 22
    
中文摘要: 针对车载捷联惯导系统(Strapdown Inertial Navigation System, SINS)的传统动基座粗对准方法精度低且环境适应性差的问题,提出了一种基于多矢量定姿的动基座最优化粗对准算法。在传统的基于重力矢量的初始对准方法基础上,将姿态矩阵求解问题转化为Wahba问题,实现对多个时刻重力矢量信息的充分利用,并通过SVD算法实现对Wahba问题的求解,结合全球导航卫星系统(Global Navigation Satellite System, GNSS)输出信息和SINS输出信息,构建状态方程和量测方程,采用Sage-Husa自适应滤波算法以解决量测噪声不准确问题,不断修正载体系变换矩阵以获得更加精确的姿态转换矩阵。仿真和半物理实验表明,改进算法能够明显提高惯导系统在动基座下的姿态精度,转台实验对准方位误差小于0.05°。
中文关键词: 捷联惯导系统;动基座对准;Wahba问题;SVD算法;Sage-Husa自适应滤波
Abstract:Aiming at the problems of low precision and poor adaptability of traditional moving base coarse alignment method for vehicle strapdown inertial navigation system (SINS), an optimal coarse alignment algorithm for moving base based on multi vector attitude determination is proposed. On the basis of the traditional initial alignment method based on gravity vector, the problem of solving attitude matrix is transformed into Wahba problem to make full use of the information of gravity vector at multiple times. The problem of solving Wahba is solved by SVD algorithm. Combining the output information of global navigation satellite system (GNSS) and SINS, the process equation and measurement equation are constructed. Sage-Husa adaptive filtering algorithm is used to solve the problem of measurement noise inaccuracy, and the transform matrix of carrier frame is continuously modified to obtain more accurate attitude conversion matrix. Simulation and semi physical experiments show that the improved algorithm can significantly improve the alignment accuracy, and the alignment azimuth error of turntable experiment is less than 0.05 °.
keywords: strapdown inertial navigation system; moving base alignment; Wahba problem; SVD algorithm; Sage-Husa adaptive filtering algorithm
文章编号:20210504     中图分类号:U666.1    文献标志码:A
基金项目:
作者单位
刘文倩 微惯性仪表与先进导航技术教育部重点实验室 东南大学 仪器科学与工程学院 
程向红 微惯性仪表与先进导航技术教育部重点实验室 东南大学 仪器科学与工程学院 
曹 鹏 上海航天控制技术研究所 
丁 鹏 微惯性仪表与先进导航技术教育部重点实验室 东南大学 仪器科学与工程学院 
Author NameAffiliation
LIU Wenqian Key Laboratory of Micro-Inertial Instrument and Advanced Navigation Technology, Ministry of Education, Southeast University; School of Instrument Science & Engineering, Southeast University 3. 
CHENG Xianghong Key Laboratory of Micro-Inertial Instrument and Advanced Navigation Technology, Ministry of Education, Southeast University; School of Instrument Science & Engineering, Southeast University 3. 
CAO Peng Shanghai Aerospace Control Technology Institute 
DING Peng Key Laboratory of Micro-Inertial Instrument and Advanced Navigation Technology, Ministry of Education, Southeast University; School of Instrument Science & Engineering, Southeast University 3. 
引用文本:
刘文倩,程向红,曹 鹏,丁 鹏.基于多矢量定姿的动基座最优化对准算法[J].飞控与探测,2021,(5):27-33.

分享按钮