Journal of Shanghai Jiao Tong University ›› 2016, Vol. 50 ›› Issue (03): 419-424.

Previous Articles     Next Articles

SINS SelfAlignment Algorithm with Inertial Frame for Swaying Base Based on Quaternion

XUE Haijian,GUO Xiaosong,ZHANG Dongfang,ZHOU Zhaofa   

  1. (State Key Discipline Laboratory of Armament Launch Theory and Technology, The Second Artillery Engineering University, Xi’an 710025, China)
  • Received:2015-04-25 Online:2016-03-28 Published:2016-03-28

Abstract: Abstract: To improve the rapidity and precision of initial alignment for strapdown inertial navigation system (SINS) under swaying base, the SINS selfalignment algorithm with inertial frame for the swaying base based on quaternion was presented, which used attitude update of inertial coordinates to reflect the gesture changes of the carrier under realtime shaking interference. The algorithm transformed the optimal estimation of the initial attitude into the Wahba problem to remove the angular interrupting by quaternion derivation, and used the wavelet denoising threshold to eliminate the linear vibration interrupting according to the different frequency characteristics of gravity vector in inertial reference frame and the disturbance. The simulation results show that the presented method can accomplish the alignment quickly and accurately under swaying base even in the presence of angular motion and linear vibration interference without the coarse alignment process.

Key words: Key words: strapdown inertial navigation system(SINS), initial alignment, quaternion, swaying base, wavelet denoising threshold

CLC Number: