系统工程与电子技术 ›› 2018, Vol. 40 ›› Issue (5): 1098-1103.doi: 10.3969/j.issn.1001-506X.2018.05.21

• 制导、导航与控制 • 上一篇    下一篇

两种SINS惯性系四元数粗对准算法等价性分析

陈河, 张志利, 周召发, 刘朋朋, 赵军阳   

  1. 火箭军工程大学兵器发射理论与技术国家重点学科实验室, 陕西 西安 710025
  • 出版日期:2018-04-28 发布日期:2018-04-25

Equivalence analysis between two quaternion based coarse alignment algorithms for SINS with inertial frame

CHEN He, ZHANG Zhili, ZHOU Zhaofa, LIU Pengpeng, ZHAO Junyang   

  1. State Key Discipline Laboratory of Armament Launch Theory and Technology, Rocket Force University of Engineering, Xi’an 710025, China
  • Online:2018-04-28 Published:2018-04-25

摘要:

针对捷联惯导系统惯性系粗对准两种四元数算法的等价性进行了详细分析。首先,根据姿态矩阵的分解原理将初始对准问题转化为多矢量定姿的Wahba问题,并根据重力矢量连续变化的特点建立了积分形式的优化目标函数。然后,根据基于四元数的坐标变换原理,将目标函数变换为关于姿态四元数的函数,进而根据四元数运算性质分别导出最优四元数的两种求解形式,并根据矩阵特征值和特征向量的性质证明了两种算法的等价性。最后,通过仿真和试验数据进一步验证了理论分析的正确性。

Abstract:

The equivalence between two quaternion based coarse alignment algorithms for strapdown inertial navigation system (SINS) with inertial frame is carefully analyzed. Firstly, the alignment of SINS is transformed into the Wahba problem in attitude determination based on the decomposition principle of the attitude matrix, and an integral form objective function to be optimized is established according to the fact that the gravity vector changes continuously. Then the objective function is transformed into the function of attitude quaternion on the basis of coordinate transformation rules in the quaternion form, and two algorithms are derived to acquire the optimal attitude quaternion. Finally the equivalence between the two algorithms is demonstrated based on the properties of matrix eigenvalues and eigenvectors, with further verification conducted with data from both simulation and field experiment.