Angular velocity estimation based on adaptive simplified spherical simplex unscented Kalman filter in GFSINS

Abstract

In this paper, the adaptive simplified spherical simplex unscented Kalman filter was proposed to calculate angular velocity in gyro-free strapdown inertial navigation system. Firstly, a general angular velocity calculation modeling method with time-varying process noise was proposed, which was not limited to a certain kind of accelerometer configuration. Then aiming at the issues of large amount of calculation of unscented Kalman filter and the time variation of the process noise, and based on the characteristics of additive noise and linear state equation, the adaptive simplified spherical simplex unscented Kalman filter was proposed to estimate the angular velocity. The sampling points were decreased in this method through adopting the spherical simplex sampling strategy and not augmenting the state, thus improving the calculation efficiency. Meanwhile, Sage–Husa suboptimal maximum a posteriori noise estimator was brought in to estimate the process noise in real time in order to settle the problem of filter divergence induced by the time variation. Lastly, the proposed algorithm was simulated and also contrasted with the integration method, the evolution method and the conventional adaptive UKF algorithm. The simulation results indicated that the adaptive simplified spherical simplex unscented Kalman filter algorithm has higher precision than the integration method and evolution method and has higher efficiency than the AUKF, which could effectively improve the calculation precision and meanwhile guarantee the calculation efficiency.

Keywords

Gyro-free angular velocity calculation Sage–Husa spherical simplex sampling unscented Kalman filter

Get full access to this article

View all access options for this article.

References

Edwan

Knedlik

Loffeld

. Constrained angular motion estimation in a gyro-free IMU. IEEE Trans Aerosp Electron Syst 2011; 47: 596–610.

Park

Tan

C-W

Park

. A scheme for improving the performance of a gyroscope-free inertial measurement unit. Sens Actuators A: Phys 2005; 121: 410–420.

Liu Z. Research on several key technologies of GFSINS. PhD Dissertation, Department of Automobile Engineering, Harbin Engineering University, Harbin, China, 2010.

Jie

Zhen

Peng

. Estimation algorithm of angular velocity in gyroscope-free inertial measurement system. J Projectiles Rockets Missiles Guidance 2010; 30(3): 25–28.

Shi Z, Yang J, Yue P, et al. Angular velocity estimation in gyroscope-free inertial measurement system based on unscented Kalman filter. In: Proceedings of the 8th world congress on intelligent control and automation, Jinan China, July 2010, pp.2031–2034.

Lei C, Shuguang S, Zijian C, et al. Application for solving angular velocity with adaptive Kalman filtering in GFSINS. In: Proceeding of the IEEE international conference on information and automation, Shenzhen, China, June 2011.

Merhav

. A non-gyroscopic inertial measurement unit. J Guidance Control 1982; 5(3): 227–235.

Wang Q, Ding M and Zhao P. A new scheme of non-gyro inertial measurement unit for estimating angular velocity. In: The 29th annual conference of the IEEE industry electronics society (IECON'2003), Roanoke, VA, USA, 2–6 November 2003, pp.1564–1567.

Pamadi KB, Ohlmeyer EJ and Pepitone TR. Assessment of a GPS guided spinning projectile using an accelerometer-only IMU. In: Guidance, navigation, and control conference and exhibit, Providence, RI, August 2004, pp.1–13.

10.

Schuler

Grammatikos

Fegley

. Measuring rotational motion with linear accelerometers. IEEE Trans Aerosp Electron Syst 1967; AES-3(3): 465–472.

11.

Chen

Lee

Daniel

DeBra . Gyroscope free strap-down inertial measurement unit by six linear accelerometers. J Guidance Control Dyn 1994; 17(3): 286–290.

12.

Julier

Uhlmann

Hugh

. A new method for the nonlinear transformation of means and covariances in filters and estimators. IEEE Trans Autom Control 2000; 45(3): 477–482.

13.

Julier

Uhlmann

. Unscented filtering and nonlinear estimation. Proc IEEE 2004; 92(3): 405–418.

14.

Forbes JR. Extended Kalman filter and sigma point filter approaches to adaptive filtering. In: AIAA guidance, navigation, and control conference, Toronto, Ontario, Canada, 2–5 August 2010, pp.1–15.

15.

Xu J. Design, analysis and application of the filter algorithm based on UKF. Ph.D. Dissertation, Department of Informatics and Engineering, Northeastern University, Shenyang, China, 2008.

16.

Julier SJ and Uhlmann JK. Reduced sigma point filters for the propagation of means and covariances through nonlinear transformations. In: Proceedings of the American control conference, Anchorage, AK, USA: IEEE, 8–10 May 2002, pp.887–892.

17.

Julier SJ. The spherical simplex unscented transformation. In: Proceedings of the American control conference, Danver, CO, USA: IEEE, 4–6 June 2003, pp. 2430–2434.

18.

Juan G Castrej′on Lozano JG, Garca Carrillo LR, Dzul A, et al. Spherical simplex sigma-point Kalman filters: a comparison in the inertial navigation of a terrestrial vehicle. In: 2008 American control conference, Seattle, WA, USA, 11–13 June 2008, pp.3536–3541.

19.

Sage AP and Husa GW. Algorithms for sequential adaptive estimation of prior statistics. In: Adaptive Processes (8th) Decision and Control, 1969, vol. 8, no. 1, pp. 6-a-8-, 6-a-9.

20.

Deng

Yan

. Kalman filtering theory and its application in the navigation system, 2nd ed. Beijing, China: Science Press, 2010, pp. 111–120.

21.

Zhang

. Approach to adaptive filtering algorithm. Acta Aeronaut et Astronaut Sin 1998; 19(7): 96–99.

22.

Zhang

. Rescue methods for preventing the divergence of adaptive Kalman filtering. Control Decis 1991; 6(1): 55–56.