Abstract
This paper conducts performance evaluation for the ultra-tight integration of Global positioning system (GPS) and inertial navigation system (INS) by use of the fuzzy adaptive strong tracking unscented Kalman filter (FASTUKF). An ultra-tight GPS/INS integration architecture involves fusion of the in-phase and quadrature components from the correlator of the GPS receiver with the INS data. These two components are highly nonlinearly related to the navigation states. The strong tracking unscented Kalman filter (STUKF) is based on the combination of an unscented Kalman filter (UKF) and strong tracking algorithm (STA) to perform the parameter adaptation task for various dynamic characteristics. The STA is basically a nonlinear smoother algorithm that employs suboptimal multiple fading factors, in which the softening factors are involved. In order to resolve the shortcoming in a traditional approach for selecting the softening factor through personal experience or computer simulation, the Fuzzy Logic Adaptive System (FLAS) is incorporated for determining the softening factor, leading to the FASTUKF. Two examples are provided for illustrating the effectiveness of the design and demonstrating effective improvement in navigation estimation accuracy and, therefore, the proposed FASTUKF algorithm can be considered as an alternative approach for designing the ultra tightly coupled GPS/INS integrated navigation system.
Similar content being viewed by others
References
Farrell, J.A., Barth, M.: The Global Positioning System & Inertial Navigation. McGraw-Hill, New York (1999)
Brown, R., Hwang, P.: Introduction to Random Signals and Applied Kalman Filtering. Wiley, New York (1997)
Babu, R., Wang, J.: Ultra-tight GPS/INS/PL integration: a system concept and performance analysis. GPS Solut. 13(1), 75–82 (2009)
Yuan, G., Zhang, T.: Unscented Kalman filtering for ultra-tightly coupled GPS/INS integration. In: Proceedings of the 2009 IEEE International Conference on Mechatronics and Automation, Changchun, China, pp. 4556–4560 (2009)
Gelb, A.: Applied Optimal Estimation. MIT Press, Cambridge (1974)
Grewal, M.S., Andrews, A.P.: Kalman Filtering, Theory and Practice Using MATLAB, 2nd edn. Wiley, New York (2001)
Julier, S.J., Uhlmann, J.K., Durrant-whyte, H.F.: A new approach for filtering nonlinear system. In: Proceeding of the American Control Conference, Seattle, pp. 1628–1632 (1995)
Julier, S.J., Uhlmann, J.K., Durrant-whyte, H.F.: A new method for the nonlinear transformation of means and covariances in filters and estimators. IEEE Trans. Autom. Control 5(3), 477–482 (2000)
Julier, S.J., Uhlmann, J.K.: Reduced sigma point filters for the propagation of means and covariances through nonlinear transformations. In: Proceeding of the American Control Conference, Anchorage, pp. 887–892 (2002)
Julier, S.J.: The scaled unscented transformation. In: Proceedings of the American Control Conference, Anchorage, USA, pp. 4555–4559 (2002)
Wan, E.A., van der Merwe, R.: The unscented Kalman filter. In: Haykin, S. (ed.) Kalman Filtering and Neural Networks, Chap. 7. Wiley, New York (2001)
Simon, D.: Optimal State Estimation, Kalman, H ∞, and Nonlinear Approaches. Wiley, New York (2006)
Mariani, S., Ghisi, A.: Unscented Kalman filtering for nonlinear structural dynamics. Nonlinear Dyn. 49, 131–150 (2007)
Wang, Y., Papageorgiou, M., Messmer, A.: Investigation of the adaptive features of a real-time nonlinear freeway traffic state estimator. Nonlinear Dyn. 49, 511–524 (2007)
Khalil, M., Sarkar, A., Adhikari, S.: Nonlinear filters for chaotic oscillatory systems. Nonlinear Dyn. 55, 115–137 (2009)
Ali, J., Ullah, R., Mirza, M.B.: Performance comparison among some nonlinear filters for a low cost SINS/GPS integrated solution. Nonlinear Dyn. 61, 491–502 (2010)
Nunes, U., Bento, L.C.: Data fusion and path-following controllers comparison for autonomous vehicles. Nonlinear Dyn. 49, 445–462 (2007)
Sotelo, M.A., Naranjo, E.: Comparative study of chained systems theory and fuzzy logic as a solution for the nonlinear lateral control of a road vehicle. Nonlinear Dyn. 49, 463–474 (2007)
Mehra, R.K.: On-line identification of linear dynamic systems with applications to Kalman filtering. IEEE Trans. Autom. Control AC-16, 12–21 (1970)
Mehra, R.K.: Approaches to adaptive filtering. IEEE Trans. Autom. Control AC-17, 693–698 (1972)
Mohamed, A.H., Schwarz, K.P.: Adaptive Kalman filtering for INS/GPS. J. Geod. 73, 193–203 (1999)
Hide, C., Moore, T., Smith, M.: Adaptive Kalman filtering for low cost INS/GPS. J. Navig. 56, 143–152 (2003)
Ding, W., Wang, J., Rizos, C.: Improving adaptive Kalman estimation in GPS/INS integration. J. Navig. 60, 517–529 (2007)
Zhou, D.H., Frank, P.M.: Strong tracking Kalman filtering of nonlinear time-varying stochastic systems with coloured noise: application to parameter estimation and empirical robustness analysis. Int. J. Control 65, 295–307 (1996)
Jwo, D.J., Wang, S.H.: Adaptive fuzzy strong tracking extended Kalman filtering for GPS navigation. IEEE Sens. J. 7(5), 778–789 (2007)
Jwo, D.J., Lai, S.-Y.: Navigation integration using the fuzzy strong tracking unscented Kalman filter. J. Navig. 62(2), 303–322 (2009)
Tong, S., Li, Y.: Observer-based fuzzy adaptive control for strict-feedback nonlinear systems. Fuzzy Sets Syst. 160(12), 1749–1764 (2009)
Tong, S., Liu, C., Li, Y.: Fuzzy adaptive decentralized control for large-scale nonlinear systems with dynamical uncertainties. IEEE Trans. Fuzzy Syst. 18(5), 845–861 (2010)
Tong, S., He, X., Zhang, H.: A combined backstepping and small-gain approach to robust adaptive fuzzy output feedback control. IEEE Trans. Fuzzy Syst. 17(5), 1059–1069 (2009)
Li, Y., Tong, S., Li, T.: Adaptive fuzzy output feedback control of uncertain nonlinear systems with unknown backlashlike hysteresis. Inf. Sci. 198, 130–146 (2012)
Sasiadek, J.Z., Wang, Q., Zeremba, M.B.: Fuzzy adaptive Kalman filtering for INS/GPS data fusion. In: Proc. 15th IEEE Int. Symp. on Intelligent Control, Rio, Patras, Greece, pp. 181–186 (2000)
GPSoft LLC: Navigation System Integration and Kalman Filter Toolbox User’s Guide (2005)
Cloud Cap Technology: Crista IMU specifications (2012). Available at http://www.cloudcaptech.com/crista_imu.shtm
Acknowledgements
This work is partially supported by the National Science Council of the Republic of China under grant numbers NSC 98-2221-E-019-021-MY3 and NSC 101-2221-E-019-027-MY3.
Author information
Authors and Affiliations
Corresponding author
Appendices
Appendix A: The derivatives in the Jacobian matrix
The derivatives in the Jacobian matrix H k are given by
and
where the following derivatives can be calculated
Taking derivatives of θ e and ω e with respect to the three components of position gives
and
respectively. Furthermore, taking derivatives of θ e and ω e with respect to the velocities gives
and
respectively.
Appendix B: Generation of the DGPS corrections
In this appendix, the typical DGPS implementation methods are reviewed [1], followed by the setup applicable for the ultra-tight GPS/INS integration. The two typical DGPS correction methods include (1) the position-space DGPS, which provides the position correction; and (2) range-space DGPS, which provides the pseudorange correction (PRC).
Since the ultra-tightly coupled architecture performs integration using the data in the correlator components I (in-phase) and Q (quadrature), derivation of the suitable DGPS corrections is necessary to fulfil the application requirements. The proposed DGPS correction method, here referred to as the correlator-space DGPS, is designed to generate the corrections for the correlator outputs. The method is summarized as follows. From Eqs. (4a), (4b), (5), and (6) in Sect. 2, E[I] and E[Q] depends on the errors of the carrier frequency and phase, and subsequently they can be described in terms of the position and velocity:
The DGPS corrections for the I and Q values can be obtained:
where E[I]GPS_base and E[Q]GPS_base are observed by the base station receiver, while E[I]cal and E[Q]cal are calculated based on the known coordinates of the (fixed reference) station. These two values can be calculated in a similar manner way as that for the INS predicted I and Q, i.e., E[I]INS and E[Q]INS, except that the former two are evaluated based on the known navigation states such that good accuracy can be achieved.
Rights and permissions
About this article
Cite this article
Jwo, DJ., Yang, CF., Chuang, CH. et al. Performance enhancement for ultra-tight GPS/INS integration using a fuzzy adaptive strong tracking unscented Kalman filter. Nonlinear Dyn 73, 377–395 (2013). https://doi.org/10.1007/s11071-013-0793-z
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s11071-013-0793-z