Zhang Tao, Zhu Yongyun, Zhou Feng, Yan Yaxiong, Tong Jinwu
School of Instrument Science and Engineering, Southeast University, Nanjing 210096, China.
Key Laboratory of Micro-Inertial Instrument and Advanced Navigation Technology, Ministry of Education, Nanjing 210096, China.
Sensors (Basel). 2017 Jun 17;17(6):1424. doi: 10.3390/s17061424.
Initial alignment of the strapdown inertial navigation system (SINS) is intended to determine the initial attitude matrix in a short time with certain accuracy. The alignment accuracy of the quaternion filter algorithm is remarkable, but the convergence rate is slow. To solve this problem, this paper proposes an improved quaternion filter algorithm for faster initial alignment based on the error model of the quaternion filter algorithm. The improved quaternion filter algorithm constructs the K matrix based on the principle of optimal quaternion algorithm, and rebuilds the measurement model by containing acceleration and velocity errors to make the convergence rate faster. A doppler velocity log (DVL) provides the reference velocity for the improved quaternion filter alignment algorithm. In order to demonstrate the performance of the improved quaternion filter algorithm in the field, a turntable experiment and a vehicle test are carried out. The results of the experiments show that the convergence rate of the proposed improved quaternion filter is faster than that of the tradition quaternion filter algorithm. In addition, the improved quaternion filter algorithm also demonstrates advantages in terms of correctness, effectiveness, and practicability.
捷联惯性导航系统(SINS)的初始对准旨在在短时间内以一定精度确定初始姿态矩阵。四元数滤波算法的对准精度显著,但收敛速度较慢。为解决此问题,本文基于四元数滤波算法的误差模型,提出一种用于更快初始对准的改进四元数滤波算法。改进的四元数滤波算法基于最优四元数算法原理构造K矩阵,并通过包含加速度和速度误差来重建测量模型,以使收敛速度更快。多普勒速度计(DVL)为改进的四元数滤波对准算法提供参考速度。为了在实际中验证改进的四元数滤波算法的性能,进行了转台实验和车辆测试。实验结果表明,所提出的改进四元数滤波器的收敛速度比传统四元数滤波算法更快。此外,改进的四元数滤波算法在正确性、有效性和实用性方面也表现出优势。