Abstract
The extended Kalman filter (EKF) is widely used for the integration of the global positioning system (GPS) and inertial navigation system (INS). It is well known that the EKF performance degrades when the system nonlinearity increases or the measurement covariance is not accurate. For the loosely coupled GPS/INS integration, accurate determination of the GPS measurement and its covariance is not a simple task. An extended state observer (ESO) is proposed for the first time to improve the navigation performance of the loosely coupled GPS/INS integration with accurate measurement modeling. The performance of the proposed method is comprehensively evaluated and analyzed, and comparisons were made with respect to the standard EKF method. Simulations and a field vehicular test were conducted to evaluate the performance of the integrated system using the proposed algorithm. The results demonstrate that the navigation performance of the proposed method can be improved significantly in terms of position and velocity when compared with the EKF method. In the simulation test, the RMS values of the positioning errors are reduced by 52.57%, 48.56%, and 34.16% in the north, east, and vertical directions, respectively. The corresponding percentage for the velocity errors are 48.20%, 43.17%, and 22.65%, respectively. In the field test, the RMS values of the positioning errors are decreased by 40.91%, 47.63%, and 12.21%, respectively. The corresponding percentage for the velocity errors are 42.13%, 31.38%, and 33.86%, respectively. The improvement of attitude accuracy is not obvious as it mainly relies on the quality of the inertial sensors.
Similar content being viewed by others
Data availability
The simulation data were generated by the open-source “PSINS” software, and the field test can be obtained from the corresponding author.
References
Astolfi D, Marconi L (2015) A high-gain nonlinear observer with limited gain power. IEEE Trans Autom Control 60(11):3059–3064. https://doi.org/10.1109/TAC.2015.2408554
Chai D, Chen G, Wang S, Lu X (2018) Loosely coupled GNSS/INS integration based on an auto regressive model in a data gap environment. Acta Geodaetica Et Geophysica Hungarica 53(4):691–715. https://doi.org/10.1007/s40328-018-0238-8
Chen X, Li D, Gao Z, Wang C (2011) Tuning method for second-order active disturbance rejection control. In: Proceedings of the 30th Chinese control conference, 6322–6327. https://doi.org/10.1109/ECBS-EERC.2011.41
Chen K, Wen Q, Xia L (2018) Hybrid ADRC system design for semi-strapdown seeker. Infrared Laser Eng 47(11):1131001. https://doi.org/10.3788/irla201847.1131001
Cui R, Chen L, Yang C, Chen M (2017) Extended state observer-based integral sliding mode control for an underwater robot with unknown disturbances and uncertain nonlinearities. IEEE Trans Ind Electron 64(8):6785–6795. https://doi.org/10.1109/TIE.2018.2868034
Esfandiari F, Khalil HK (1992) Output feedback stabilization of fully linearizable systems. Int J Control 56(5):1007–1037. https://doi.org/10.1080/00207179208934355
Freidovich LB, Khalil HK (2008) Performance recovery of feedback linearization-based designs. IEEE Trans Autom Control 53(10):2324–2334. https://doi.org/10.1109/TAC.2008.2006821
Gauthier JP, Hammouri H, Othman S (1992) A Simple Observer for Nonlinear Systems. Application to Bioreactors. IEEE Trans Autom Control 37(6):875–880. https://doi.org/10.1109/9.256352
Gordon NJ, Salmond DJ, Smith AFM (2002) Novel approach to nonlinear/non-Gaussian Bayesian state estimation. IEE Proc F—Radar Signal Process 140(2):107–113. https://doi.org/10.1049/ip-f-2.1993.0015
Guo B, Zhao Z (2011) Extended State Observer for Nonlinear Systems with Uncertainty. IFAC Proc Vol 44(1):1855–1860. https://doi.org/10.3182/20110828-6-IT-1002.00399
He T, Wu Z, Shi R, Li D, Sun L, Wang L, Zheng S (2019) Maximum sensitivity-constrained data-driven active disturbance rejection control with application to airflow control in power plant. Energies 12(2):231. https://doi.org/10.3390/en12020231
Hua B, Zhang Z, Wu Y, Chen Z (2018) Autonomous navigation algorithm based on AUKF filter about fusion of geomagnetic and sunlight directions. Int J Intell Comput Cybern 11(4):471–485. https://doi.org/10.1108/IJICC-07-2017-0087
Johnson CD (1968) Optimal control of the linear regulator with constant disturbances. IEEE Trans Auto Control 13(4):416–421. https://doi.org/10.1109/TAC.1968.1098947
Johnson CD (1971) Accommodation of external disturbances in linear regulator and servomechanism problems. IEEE Trans Autom Control 16(6):635–644. https://doi.org/10.1109/TAC.1971.1099830
Karagiannis D, Carnevale D, Astolfi A (2008) Invariant manifold based reduced-order observer design for nonlinear systems. IEEE Trans Autom Control 53(11):2602–2614. https://doi.org/10.1109/TAC.2008.2007045
Kazantzis N, Kravaris C (1998) Nonlinear observer design using Lyapunov’s auxiliary theorem. Syst Control Lett 34(5):241–247. https://doi.org/10.1016/S0167-6911(98)00017-6
Khalil HK (2017) Cascade high-gain observers in output feedback control. Automatica 80:110–118. https://doi.org/10.1016/j.automatica.2017.02.031
Kim KS, Rew KH, Kim S (2010) Disturbance observer for estimating higher order disturbances in time series expansion. IEEE Trans Autom Control 55(8):1905–1911. https://doi.org/10.1109/TAC.2010.2049522
Kim Y, Song J, Yun H, Kee C, Park B (2016) Optimal selection of an inertial sensor for cycle slip detection considering single-frequency RTK/INS integrated navigation. Trans Japan Soc Aeronaut Space Sci 58(4):205–217. https://doi.org/10.2322/tjsass.59.205
Konatowski S, Kaniewski P, Matuszewski J (2016) Comparison of estimation accuracy of EKF, UKF and PF filters. Annu Navi 23(1):68–87. https://doi.org/10.1515/aon-2016-0005
Krener AJ, Xiao MQ (2002) Nonlinear observer design in the Siegel domain. Siam J Control Optim 41(3):932–953. https://doi.org/10.1137/S0363012900375330
Liu B, Hong J, Wang L (2019) Linear inverted pendulum control based on improved ADRC. Syst Sci Control Eng Open Access J 7(3):1–12. https://doi.org/10.1080/21642583.2019.1625081
Lotufo MA, Colangelo L, Perezmontenegro C, Canuto E, Novara C (2019) UAV quadrotor attitude control: an ADRC-EMC combined approach. Control Eng Pract 84(1):12–22. https://doi.org/10.1016/j.conengprac.2018.11.002
Luenberger DG (1964) Observing the state of a linear system. IEEE Trans Mil Electron 8(2):74–80. https://doi.org/10.1109/TME.1964.4323124
Luenberger D (2003) Observers for multivariable systems. IEEE Trans Autom Control 11(2):190–197. https://doi.org/10.1109/TAC.1966.1098323
Ma Q, Xv Q, Wang W (2011) ADRC with synthesis tuning algorithm for main steam pressure of CFBB. Commun Comput Inf Sci 176:47–52. https://doi.org/10.1007/978-3-642-21802-6_8
Manzanilla A, Reyes S, Garcia MA, Mercado DA, Lozano R (2019) Autonomous navigation for unmanned underwater vehicles: real-time experiments using computer vision. Int Conf Robot Autom 4(2):1351–1356. https://doi.org/10.1109/LRA.2019.2895272
Ran M, Xie L, Li J (2019) Time-varying formation tracking for uncertain second-order nonlinear multi-agent systems. J Zhejiang Univ Sci C 20(1):76–87. https://doi.org/10.1631/FITEE.1800557
Shin E H (2004) A quaternion-based unscented Kalman filter for the integration of GPS and MEMS INS. 2004. In: Proceedings of ION GNSS, 1060–1068, Long Beach, CA. https://www.ion.org/publications/abstract.cfm?articleID=5782
Song C, Wei C, Yang F, Cui N (2018) High-order sliding mode-based fixed-time active disturbance rejection control for quadrotor attitude system. Electronics 7(12):357. https://doi.org/10.3390/electronics7120357
Tseng C, Lin S, Jwo D (2017) Robust huber-based cubature Kalman filter for GPS navigation processing. J Navig 70(3):527–546. https://doi.org/10.1017/S0373463316000692
Utkin VI (1964) Principles of identification using sliding regimes. Soviet Phys Dokl 26(3):271–272. https://doi.org/10.1080/0020717940892312
Walcott BL, Zak SH (1986) Observation of dynamical systems in the presence of bounded nonlinearities/uncertainties. IEEE Conf Decis Control 25(25):961–966. https://doi.org/10.1109/CDC.1986.267514
Wang C, Han Y, Chen J, Wang S, Zhang Z, Du N, Zheng Y (2018) A GNSS/INS integrated navigation algorithm based on Kalman filter. IFAC-PapersOnLine 51(17):232–237. https://doi.org/10.1016/j.ifacol.2018.08.151
Wang Y, Meng X, Liu J (2018) An improved adaptive extended Kalman filter algorithm of SINS/GPS loosely-coupled integrated navigation system. Int J Eng Technol 7(1):87. https://doi.org/10.14419/ijet.v7i4.27.22488
Wang J, He X, Wei Z, Lu Y, He D, Mu Z, Ling J, Ma Z (2019) An attitude tracking method for star sensor under dynamic conditions. Optoelectron Lett 15(5):368–373. https://doi.org/10.1007/s11801-019-8197-z
Wu D, Chen K (2014) Limit cycle analysis of active disturbance rejection control system with two nonlinearities. ISA Trans 53(4):947–954. https://doi.org/10.1016/j.isatra.2014.03.001
Yang Y, Xu T (2003) An adaptive Kalman filter based on sage windowing weights and variance components. J Navig 56(2):231–240. https://doi.org/10.1017/S0373463303002248
Yu MJ (2007) INS/GPS integration system using adaptive filter for estimating measurement noise variance. IEEE Trans Aerosp Electron Syst 48(2):1786–1792. https://doi.org/10.1109/TAES.2012.6178100
Yuan Y, Cheng L, Wang Z, Sun C (2019) Position tracking and attitude control for quadrotors via active disturbance rejection control method. Sci China Ser F Inf Sci 62(1):010201. https://doi.org/10.1007/s11432-018-9548-5
Zhang C (2018) Distributed ESO based cooperative tracking control for high-order nonlinear multi-agent systems with lumped disturbance and application in multi flight simulators systems. ISA Trans 74(3):217–228. https://doi.org/10.1016/j.isatra.2018.01.020
Zhang Y, Fan C, Zhao F, Ai Z, Gong Z (2014) Parameter tuning of ADRC and its application based on CCCSA. Nonlinear Dyn 76(2):1185–1194. https://doi.org/10.1007/s11071-013-1201-4
Zheng J, Guo F (2016) An adaptive stochastic model for GPS observations and its performance in precise point positioning. Survey Review 48:349. https://doi.org/10.1179/1752270615Y.0000000033
Acknowledgements
We would like to thank the anonymous reviewers for their valuable comments, which greatly improved the quality of this manuscript. This study was supported in part by the National Key Research and Development Program of China (Grant No. 2020YFC1512003), the State Key Program of National Natural Science Foundation of China (Grant NO. 41931075), and the National Natural Science Foundation of China (Grant NO. 41804026). We would like to thank the “PSINS” software to generate the simulated GPS/INS data and the GNSS/INS Research Group from GNSS Research Center, Wuhan University for providing the field test data.
Author information
Authors and Affiliations
Corresponding author
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
About this article
Cite this article
Jiang, H., Shi, C., Li, T. et al. Low-cost GPS/INS integration with accurate measurement modeling using an extended state observer. GPS Solut 25, 17 (2021). https://doi.org/10.1007/s10291-020-01053-3
Received:
Accepted:
Published:
DOI: https://doi.org/10.1007/s10291-020-01053-3