Precision Quaternion Based One Step Strapdown Attitude Algorithm

Abstract

Calculative algorithms of Strapdown inertial navigation systems (SINS) can be divided on navigation algorithms, which transform accelerometers output signals into local coordinates and attitude algorithms, which transform gyroscopes output signals into vehicle angular attitude [1]. Wherein, navigation task solution requires double integration of acceleration and attitude task -integration of kinematic attitude equation, related measured object angular velocity with attitude parameters. Paper considered of autonomous position determination methods based on vehicle angular velocity information without acceleration measurement. Thus, attitude algorithms are considered only. Paper researched the errors of algorithm based on quaternion attitude equation, moreover algorithm error drifts were accepted as a main accuracy characteristic The main part. Algorithm researched by imitation modeling of vehicle's computer with SINS attitude algorithm. The main task of modeling is defining depends between algorithm drift and sensor's call step in cases of different frequencies and amplitudes of base angular oscillations. It was researched four one-step algorithms: reverse, based on modified Euler method; Picard method with two successive approximations and the new author's algorithm which combines formulas of first two algorithms. It was studied depends of algorithm drift and faze shift between two orthogonal axes oscillations. It was shown, the biggest drift values are obtained in case of base conning movement. It was made the modeling researches of algorithm drift amplitudes relatively to sensor sample steps and oscillation frequencies in dimensionless form. It was shown, substantial increase new algorithm accuracy compared to other researched.Conclusions. The algorithm drift accuracy of new algorithm in 2600 times exceeds the revers algorithm. Small modification of one-step algorithm allowed increase accuracy in few orders, almost without computing increase. Received results allows to expend attitude algorithms application area and prognose their accuracy with different base movement.