The New Analytical Algorithm for Determining the Strapdown INS Orientation

The analytical solution of an approximate (truncated) equation for the vector of a rigid body finite rotation has made it possible to solve the problem of determining the quaternion of orientation of a rigid body for an arbitrary angular velocity and small angle of rotation of a rigid body with the help of quadratures. Proceeding from this solution, the following approach to the construction of the new analytical algorithm for computation of a rigid body orientation with the use of strapdown INS is proposed: 1) By the set components of the angular velocity of a rigid body on the basis of mutually — unambiguous changes of the variables at each time point, a new angular velocity of a rigid body is calculated; 2) Using the new angular velocity and the initial position of a rigid body, with the help of the quadratures we find the exact solution of an approximate linear equation for the vector of a rigid body finite rotation with a zero initial condition; 3) The value of the quaternion orientation of a rigid body (strapdown INS) is determined by the vector of finite rotation. During construction of the algorithm for strapdown INS orientation at each subsequent step the change of the variables takes into account the previous step of the algorithm in such a way that each time the initial value of the vector of finite rotation of a rigid body will be equal to zero. Since the proposed algorithm for the analytical solution of the approximate linear equation for the vector of finite rotation is exact, it has a regular character for all angular motions of a rigid body).

analytical solution, algorithm, orientation, vector of finite r otation, arbitrary angular velocity, rigid body, strapdown INS, quaternion

1. Molodenkov A. V., Sapunkov Ya. G., Molodenkova T. V., Perelyaev S. E. The exact solution of the Bortz approximate equation and construction of the quaternion orientation algorithm of strapdown INS on its basis, in Proc. of 25th Saint Petersburg International Conference on Integrated Navigation Systems, St. Petersburg, ICINS 2018, CRSI Electropribor, 2018, pp. 1—4.

2. Molodenkov A. V., Sapunkov Ya. G., Molodenkova T. V. The exact solution of the Bortz approximate equation and construction of the quaternion orientation algorithm of SINS on its basis, Mekhatronika, Avtomatizatsiya, Upravlenie, 2016, vol. 17, no. 5. pp. 335—340.

3. Branetz V. N., Shmyglevskij I. P. Primenenie kvaternionov v zadachah orientacii tverdogo tela (Application of Quaternions to Rigid Body Orientation Problems), Moscow, Nauka, 1973, 320 p. (in Russian).

4. Savage P. G. Strapdown inertial navigation integration algorithm design. Part 1: Attitude algorithms, J. Guidance Control Dynamics, 1998, vol. 21, no. 1, pp. 19—28.

5. Savage P. G. Strapdown analytics. Strapdown Associates Inc., Maple Plan, Minnesota, 2007.

6. Molodenkov A. V. On the solution of the Darboux problem, Mechanics of Solids, 2007, vol. 42, no. 2, pp. 167—176.

7. Mark J. G., Tazartes D. A. Tuning of coning algorithms to gyro data frequency response characteristics, J. Guidance Control Dynamics, 2001, vol. 24, no. 4, pp. 641—646.