0
Research Papers

Nonlinear Observer for Tightly Integrated Inertial Navigation Aided by Pseudo-Range Measurements

[+] Author and Article Information
Tor A. Johansen

Department Engineering Cybernetics,
Center for Autonomous Marine Operations
and Systems (NTNU-AMOS),
Norwegian University of Science
and Technology,
Trondheim 7491, Norway
e-mail: tor.arne.johansen@itk.ntnu.no

Jakob M. Hansen

Department Engineering Cybernetics,
Center for Autonomous Marine Operations
and Systems (NTNU-AMOS),
Norwegian University of Science and Technology,
Trondheim 7491, Norway

Thor I. Fossen

Department Engineering Cybernetics,
Center for Autonomous Marine Operations
and Systems (NTNU-AMOS),
Norwegian University of Science
and Technology,
Trondheim 7491, Norway
e-mail: thor.fossen@ntnu.no

Contributed by the Dynamic Systems Division of ASME for publication in the JOURNAL OF DYNAMIC SYSTEMS, MEASUREMENT, AND CONTROL. Manuscript received March 5, 2015; final manuscript received August 7, 2016; published online October 17, 2016. Assoc. Editor: Jingang Yi.

J. Dyn. Sys., Meas., Control 139(1), 011007 (Oct 17, 2016) (10 pages) Paper No: DS-15-1088; doi: 10.1115/1.4034496 History: Received March 05, 2015; Revised August 07, 2016

A modular nonlinear observer for inertial navigation aided by pseudo-range measurements is designed and analyzed. The attitude observer is based on a recent nonlinear complementary filter that uses magnetometer and accelerometer vector measurements to correct the quaternion attitude estimate driven by gyro measurements, including gyro bias estimation. A tightly integrated translational motion observer is driven by accelerometer measurements, employs the attitude estimates, and makes corrections using the pseudo-range and range-rate measurements. It estimates position, range bias errors, velocity and specific force in an earth-fixed Cartesian coordinate frame, where the specific force estimate is used as a reference vector for the accelerometer measurements in the attitude observer. The exponential stability of the feedback interconnection of the two observers is analyzed and found to have a semiglobal region of attraction with respect to the attitude observer initialization and local region of attraction with respect to translational motion observer initialization. The latter is due to linearization of the range measurement equations that is underlying the selection of injection gains by solving a Riccati equation. In typical applications, the pseudo-range equations admit an explicit algebraic solution that can be easily computed and used to accurately initialize the position and velocity estimates. Hence, the limited region of attraction is not seen as a practical limitation of the approach for many applications. Advantages of the proposed nonlinear observer are low computational complexity and a solid theoretical foundation.

FIGURES IN THIS ARTICLE
<>
Copyright © 2017 by ASME
Your Session has timed out. Please sign back in to continue.

References

Farrell, J. A. , 2008, Aided Navigation: GPS With High Rate Sensors, McGraw-Hill, New York.
Grewal, M. , Weill, L. R. , and Andrews, A. P. , 2007, Global Positioning Systems, Inertial Navigation and Integration, Wiley, New York.
Groves, P. D. , 2013, Principles of GNSS, Inertial, and Multisensor Integrated Navigation Systems, 2nd ed., Artech House Remote Sensing Library, London.
Gustafsson, F. , 2012, Statistical Sensor Fusion, Studentliteratur, Linköpings University, Linköping, Sweden.
Markley, F. , 2003, “ Attitude Error Representation for Kalman Filtering,” J. Guid., Control Dyn., 26(2), pp. 311–317. [CrossRef]
Crassidis, J. L. , Markley, F. L. , and Cheng, Y. , 2007, “ Survey of Nonlinear Attitude Estimation Methods,” J. Guid., Control Dyn., 30(1), pp. 12–28. [CrossRef]
Reif, K. , Sonnemann, F. , and Unbehauen, R. , 1998, “ An EKF-Based Nonlinear Observer With a Prescribed Degree of Stability,” Automatica, 34(9), pp. 1119–1123. [CrossRef]
Grip, H. F. , Fossen, T. I. , Johansen, T. A. , and Saberi, A. , 2013, “ Nonlinear Observer for GNSS-Aided Inertial Navigation With Quaternion-Based Attitude Estimation,” American Control Conference, Washington, DC, June 17–19, pp. 272–279.
Morgado, M. , Batista, P. , Oliveira, P. , and Silvestre, C. , 2011, “ Position and Velocity USBL/IMU Sensor-Based Navigation Filter,” IFAC World Congress, Milan, Italy, Aug. 28–Sept. 3, pp. 13642–13647.
Batista, P. , Silvestre, C. , and Oliveira, P. , 2013, “ GAS Tightly Coupled LBL/USBL Position and Velocity Filter for Underwater Vehicles,” European Control Conference, Zurich, Switzerland, July 17–19, pp. 2982–2987.
Batista, P. , 2015, “ GES Long Baseline Navigation With Unknown Sound Velocity and Discrete-Time Range Measurements,” IEEE Trans. Control Syst. Technol., 23(1), pp. 219–230. [CrossRef]
Batista, P. , Silvestre, C. , and Oliveira, P. , 2014, “ Sensor-Based Long Baseline Navigation: Observability Analysis and Filter Design,” Asian J. Control, 16(4), pp. 974–994. [CrossRef]
Batista, P. , Silvestre, C. , and Oliveira, P. , 2015, “ Tightly Coupled Long Baseline/Ultra-Short Baseline Integrated Navigation Systems,” Int. J. Syst. Sci., 47(8), pp. 1837–1855. [CrossRef]
Batista, P. , 2014, “ GES Long Baseline Navigation With Clock Offset Estimation,” European Control Conference, Strasbourg, France, June 24–27, pp. 3011–3016.
Mahoney, R. , Hamel, T. , and Pfimlin, J.-M. , 2008, “ Nonlinear Complementary Filters on the Special Orthogonal Group,” IEEE Trans. Autom. Control, 53(5), pp. 1203–1218. [CrossRef]
Grip, H. F. , Fossen, T. I. , Johansen, T. A. , and Saberi, A. , 2012, “ Attitude Estimation Using Biased Gyro and Vector Measurements With Time-Varying Reference Vectors,” IEEE Trans. Autom. Control, 57(5), pp. 1332–1338. [CrossRef]
Johansen, T. A. , and Fossen, T. I. , 2015, “ Nonlinear Observer for Inertial Navigation Aided by Pseudo-Range and Range-Rate Measurements,” European Control Conference, Linz, Austria, July 15–17, pp. 1673–1680.
Bryne, T. H. , Hansen, J. M. , Rogne, R. H. , Sokolova, N. , Fossen, T. I. , and Johansen, T. A. , 2016, “ Nonlinear Observers for Integrated INS/GNSS Navigation—Implementation Aspects,” IEEE Control Systems Magazine (in press).
Hansen, J. M. , Johansen, T. A. , and Fossen, T. I. , 2016, “ Tightly Coupled Integrated Inertial and Real-Time-Kinematic Positioning Approach Using Nonlinear Observer,” American Control Conference, Boston, MA, pp. 5511–5518.
Dardari, D. , Falletti, E. , and Luise, M. , 2012, Satellite and Terrestrial Radio Positioning Techniques, Academic Press, Cambridge, MA.
Bancroft, S. , 1985, “ An Algebraic Solution to the GPS Equations,” IEEE Trans. Aerosp. Electron. Syst., 21(1), pp. 56–59. [CrossRef]
Chaffee, J. , and Abel, J. , 1994, “ On the Exact Solutions of Pseudorange Equations,” IEEE Trans. Aerosp. Electron. Syst., 30(4), pp. 1021–1030. [CrossRef]
Yan, J. , Tiberus, C. C. J. M. , Janssen, G. J. M. , Tennissen, P. J. G. , and Bellusci, G. , 2013, “ Review of Range-Based Positioning Algorithms,” IEEE Aerosp. Electron. Syst. Mag., Part II, 28(8), pp. 2–27. [CrossRef]
Shuster, M. , and Oh, S. , 1981, “ Three-Axis Attitude Determination for Vector Observations,” J. Guid., Control Dyn., 4(1), pp. 70–77. [CrossRef]
Anderson, B. D. O. , 1971, “ Stability Properties of Kalman–Bucy Filters,” J. Franklin Inst., 291(2), pp. 137–144. [CrossRef]
Kalman, R. E. , and Bucy, R. S. , 1961, “ New Results in Linear Filtering and Prediction Theory,” ASME J. Basic Eng., 83(1), pp. 95–109. [CrossRef]
Khalil, H. K. , 2002, Nonlinear Systems, Prentice-Hall, Upper Saddle River, NJ.
Horn, R. A. , and Johnson, C. R. , 2013, Matrix Analysis, 2 ed., Cambridge University Press, New York. [PubMed] [PubMed]

Figures

Grahic Jump Location
Fig. 1

Observer block diagram

Grahic Jump Location
Fig. 3

Position estimation errors of nonlinear observer (red), nonlinear observer with ARE (black), and MEKF (blue). The RTK solution is used as reference.

Grahic Jump Location
Fig. 4

Estimated attitude of nonlinear observer (red), nonlinear observer with ARE (black), and MEKF (blue)

Grahic Jump Location
Fig. 2

Trajectory of the unmanned aerial vehicle (UAV)

Tables

Errata

Some tools below are only available to our subscribers or users with an online account.

Related Content

Customize your page view by dragging and repositioning the boxes below.

Related Journal Articles
Related eBook Content
Topic Collections

Sorry! You do not have access to this content. For assistance or to subscribe, please contact us:

  • TELEPHONE: 1-800-843-2763 (Toll-free in the USA)
  • EMAIL: asmedigitalcollection@asme.org
Sign In