Model aided airborne integrated navigation system based on an improved square-root unscented H ∞ filter

Abstract

An inertial navigation system (INS) aided with an aircraft dynamic model (ADM) is developed as a novel airborne integrated navigation system, coping with the absence of a global navigation satellite system. To overcome the shortcomings of the conventional linear integration of INS/ADM based on an extended Kalman filter, a nonlinear integration method is proposed. Fast-update ADM makes it possible to utilize a direct filtering method, which employs nonlinear INS mechanics as system equations and a nonlinear ADM as observation equations, substituting the indirect filtering based on linear error equations. The strong nonlinearity generally calls for an unscented Kalman filter to accomplish the fusion process. Dealing with the model uncertainty, the inaccurate statistical characteristics of the noise and the potential nonpositive definiteness of the covariance matrix, an improved square-root unscented H_∞ filter (ISRUHF) is derived in the paper, in which the robust factor $γ$ is further expanded into a diagonal matrix $Γ$ , to improve the accuracy and robustness of the integrated navigation system. Corresponding simulations as well as real flight tests based on a small-scale fixed-wing aircraft are operated and ISRUHF shows superiority compared with the commonly used fusion algorithm.

Keywords

Model aided navigation system INS/ADM direct filtering real flight tests

Get full access to this article

View all access options for this article.

References

Arifianto

Farhood

(2015) Development and modeling of a low-cost unmanned aerial vehicle research platform. Journal of Intelligent & Robotic Systems 80(1): 139–164.

Athans

Wishner

Bertolini

(2003) Suboptimal state estimation for continuous-time nonlinear systems from discrete noisy measurements. IEEE Transactions on Automatic Control 13(5): 504–514.

Bryson

Sukkarieh

(2004) Vehicle model aided inertial navigation for a UAV using low-cost sensors. In: Australasian conference on robotics and automation (ACRA 2004), Canberra, Australia, 6–8 December 2004.

Ducard

(2009) Fault-tolerant Flight Control and Guidance Systems: Practical Methods for Small Unmanned Aerial Vehicles. New York: Springer Science & Business Media.

Etkin

(2012) Dynamics of Atmospheric Flight. New York, USA: Courier Corporation.

Fresconi

Harkins

(2011) Aerodynamic characterizations of asymmetric and maneuvering 105mm, 120mm, and 155mm fin-stabilized projectiles derived from telemetry experiments. In: AIAA atmospheric flight mechanics conference, Portland, USA, 8–11 August 2011, pp. 62–68. Reston: AIAA.

Hegrenas

Berglund

Hallingstad

(2008) Model-aided inertial navigation for underwater vehicles. In: IEEE international conference on robotics and automation (ICRA 2008), Pasadena, USA, 19–23 May 2008, pp. 1069–1076. Piscataway: IEEE Press.

Julier

Uhlmann

Durrant-Whyte

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

Julier

Uhlmann

Durrant-Whyte

(2002) A new approach for filtering nonlinear systems. In: 1995 american control conference, Seattle, USA, 21–23 June 1995, pp. 1628–1632. Piscataway: IEEE Press.

10.

Klein

Morelli

(2006) Aircraft System Identification: Theory and Practice. Reston: AIAA.

11.

Koifman

Bar-Itzhack

(2002) Inertial navigation system aided by aircraft dynamics. IEEE Transactions on Control Systems Technology 7(4): 487–493.

12.

Liu

Lai

Xiong

(2009) Sigma-point direct Kalman filtering algorithm for inertial integrated navigation system. Control and Decision 24(7): 1018–1022.

13.

Jia

(2010) H-infinity filtering for a class of nonlinear discrete-time systems based on unscented transform. Signal Processing 90(12): 3301–3307.

14.

Marqués

Da Ronch

(2017) Advanced UAV Aerodynamics, Flight Stability and Control, Novel Concepts, Theory and Applications. Southport, UK: John Wiley & Sons.

15.

Meng

Gao

Zhong

Subic

(2016) Covariance matching based adaptive unscented Kalman filter for direct filtering in INS/GNSS integration. Acta Astronautica 120: 171–181.

16.

Merwe

RVD

Wan

(2002) The square-root unscented Kalman filter for state and parameter-estimation. In: IEEE international conference on acoustics, speech, and signal processing, Salt Lake City, UT, USA, pp. 3461–3464. Piscataway: IEEE Press.

17.

Miller

Gaston

Irwin

(1991) A novel broadcast architecture for the square root Kalman filter. In: Algorithms and architectures for real-time control, Bangor, UK, 11–13 September 1991, pp. 57–61. Oxford: Pergamon Press.

18.

Morgado

Oliveira

Silvestre

Vasconcelos

(2014) Embedded vehicle dynamics aiding for USBL/INS underwater navigation system. IEEE Transactions on Control Systems Technology 22(1): 322–330.

19.

Sahoo

Dash

(2015) Robust estimation of power quality disturbances using unscented H_∞ filter. International Journal of Electrical Power Energy Systems 73: 438–447.

20.

Shen

Deng

(1997) Game Theory Approach to Discrete H_∞ Filter Design. Piscataway: IEEE Press.

21.

Simon

(2006) Optimal State Estimation: Kalman, H_∞, and Nonlinear Approaches. New York, USA: John Wiley & Sons.

22.

Stevens

Lewis

Johnson

(2015) Aircraft Control and Simulation: Dynamics, Controls Design, and Autonomous Systems. New Jersey, USA: John Wiley & Sons.

23.

Vasconcelos

Silvestre

Oliveira

Guerreiro

(2010) Embedded UAV model and laser aiding techniques for inertial navigation systems. Control Engineering Practice 18(3): 262–278.

24.

Wisnoe

Effendy

Nasir

Kuntjoro

Mohd

Mamat

(2009) Wind tunnel experiments and CFD analysis of blended wing body (BWB) unmanned aerial vehicle (UAV) at Mach 0.1 and Mach 0.3. In: 13th international conference on aerospace sciences aviation technology (ASAT-13), Cairo, Egypt, 26–28 May 2009, pp. 24025292–24036138.

25.

Yongyuan

(2015) Kalman Filter and Principle of Integrated Navigation. Xian, China: Northwestern Polytechnical University Press.