Methods and Algorithms for Correcting Kinematic Equations in the Problem of Determining the Orientation of an Object

Algorithms of a strapdown inertial orientation system with an inertial measurement module consisting of a three-component gyroscope, accelerometer, and magnetometer are considered. The aim of the work is to improve the algorithms for processing sensor information to ensure the asymptotic stability of the system, tuning for the Schuler period and the low-pass filter with a given bandwidth. The kinematic Poisson equations with positional and integral-positional correction based on the information of accelerometers and magnetometers are considered. The stability and frequency characteristics of the system in relation to the sensor output signals are analyzed. It is shown that the positional correction in each channel does not allow you to adjust the system for the Schuler period. The integral-positional correction allows this adjustment, but in relation to the gyroscope signals, the system is a bandpass filter and does not suppress noise in the bandwidth. The advantages of using positional correction with cross-links in the sense of tuning the frequency characteristics of the system to the Sharper frequency and the third-order low-pass filter are shown. The analysis of the influence of angular velocities confirmed the asymptotic stability of the system with their changes in a given range. The results of mathematical modeling confirmed the compensation of errors in the initial orientation system display, the reduction of noise power in the estimates of the orientation angles in relation to the noise in the sensor signals, and the ability to configure the system for the Schuler period.

1. Matveev V. V., Raspopov V. Ya. Fundamentals of construction of free-form inertial navigation systems, St. Petersburg, Koncern CNII "Electropribor", 2009, 280 p. (in Russian).

2. Anuchin O. N., Emeliantsev G. I. Integrated systems of orientation and navigation for marine mobile objects, St. Petersburg, Koncern CNII "Electropribor", 2003, 390 p. (in Russian).

3. Branets V. N., Shmyglevsky I. P. Introduction to the theory of free-form inertial navigation systems, Moscow, Nauka, 1992, 280 p. (in Russian).

4. Chelnokov Yu. N. Quaternion models and methods of aerodynamics, navigation and motion control, Moscow, Fizmatlit, 2011, 560 p. (in Russian).

5. Plotnikov P. K., Lucev S. A. On the stability of algorithms to determine turn angles of the object signals gyro strapdown navigation systems, Izvestia vuzov. Priborostroenie, 1991, vol. XXXIV, no. 10, pp. 62—68 (in Russian).

6. Plotnikov P. K. Elements of the theory work the same variety of strapdown inertial orientation systems, Gyroscopy and Navigation, 1999, no. 3, pp. 23—35 (in Russian).

7. Plotnikov P. K. Construction and analysis of quaternion differential equations the problem of determining the orientation of a rigid body with the help of a strapdown inertial navigation system, Mechanica Tverdogo Tela, 1999, no. 2, pp. 3—14 (in Russian).

8. Premerlani W. Bizard P. Direction Cosine matrix IMU: Theory, 2009, 30 p. available at: http://gentlenav.googlecode.com/files/DCMDraft2.pdf

9. Zhidkova N. V., Volkov V. L. Simulation of strapdown inertial orientation system, Sovremennue Problemu Nayki i Obrazovania, 2015, no. 1, pp. 4—14 (in Russian).

10. Volkov V. L., Zhidkova N. V. Information processing in the orientation system based on MEMS, Trudu Nigegorodskogo gosydarstvennogo tehnicheskogo universiteta imeni R. E. Alekseeva. Mikromehanicheskie Sistemu, 2015, no. 3, pp. 279—286 (in Russian).

11. Aleshkin V. V., Golovanov P. N. Model BSO of a small-sized aircraft based on a micromechanical inertial measurement module, Problemu ypravlenia, obrabotki i peredachi informacii, ICIT 2018 — VI International Scientific Conference. Saratov, Lodi, 2019. pp. 79—84 (in Russian).

12. Aleshkin V. V., Zdrazhevsky R. A., Golovanov P. N., Marusich V. O. Method of autonomous orientation of a moving object using an inertial measurement module, patent No. 2738342 Russian Federation (in Russian).

13. Polyak B. T., Shcherbakov P. S. Robust stability and control, Moscow, Nauka, 2002, 303 p. (in Russian).

14. Savage P. G. Strapdown analytics, Published by Strap-down Assosiates, Inc. Maple Plain, Minnesota, 2000, vol. 1, 2.

15. Li W., Wang J. Effective adaptive Kalman filter for MEMS IMU / magnetometters integrated attitude and heading reference systems, Journal of Navigation, 2013, vol. 66, no. 1, pp. 99—113.

16. Edwan E., Zhang J., Zxou J., Loffeld O. Reduced DCM based attitude estimation using low-cost IMU and magnetometer triad, in Proceedings of the 8 th Workshop on Positioning Navigation and Communication (WPNC 11), pp. 1-6, IEEE, Dresden, Germany, April 2011.

17. Zhu R., Sun D., Zhou Z., Wang D. A linear fusion algoritm for attitude determination using low cost MEMSbased sensors, Measurement, 2007, vol. 40, no. 3, pp. 322—328.

18. Mahony R., Hamel T., Plimlin J.-M. Nonlinear complementary filters on the special orthogonal group, IEEE Transaction on Automatic Control, 2008, vol. 53, no. 5, pp. 1203—1218.

19. Hyyti H., Visala A. A DCM based attitude estimation algorithm for low-cost MEMS IMUs, Intarnational Journal of Navigation and Oservation, 2015, ID 503814, 18 p., available at: http://dx.doi.org/10.1155/2015/503814