All-attitude Navigation and Control in SINS Based on Error Quaternions

WANG Ya-feng,LIU Hua-ping,SUN Fu-chun,ZHANG You-an

DOI: https://doi.org/10.3969/j.issn.1005-6734.2007.04.003

2007-01-01

Abstract:Using Eulerian angle information in rudder-control-loop is a general method in the strapdown inertial navigation system(SINS) of aerocraft. In order to avoid algorithm stiff numerical problem, a quaternions attitude algorithm was introduced. But, what imported into rudder-control-loop is still the Eulerian angle information. Traditional methods of using Eulerian angle to control the rudder (thrust) of the aerocraft have two shortcomings, that is, the physic stiff numerical problem of using Eulerian angle attitude algorithm at vertical state, and long controlling path. This paper analyzed these two shortcomings, then presented a new navigation method of using error quaternions to control rudder (thrust) in SINS. This method has the advantage of controlling path being the shortest, and overcomes the physic stiff numerical problem. It is not limited to the attitude of aerocraft, so it is called as all-attitude navigation method. The simulation result shows its feasibility and validity.