Skip to main content
Log in

An Improved UFastSLAM With Generalized Correntropy Loss and Adaptive Genetic Resampling

  • Regular Papers
  • Robot and Applications
  • Published:
International Journal of Control, Automation and Systems Aims and scope Submit manuscript

Abstract

The simultaneous localization and mapping (SLAM) is a research hotspot in robot navigation. In this paper, an improved UFastSLAM with generalized correntropy loss and adaptive genetic resampling is proposed. Specifically, the unscented Kalman filter algorithm with generalized correntropy loss is improved as the importance sampling in particle filter. Then, an adaptive genetic algorithm is employed to complete the resampling of particle filter. Finally, the improved UFastSLAM with generalized correntropy loss is presented to complete robot tracking. The proposed algorithm can complete robot tracking with high accuracy performance, and obtain reliable state estimation under the non-Gaussian measurement noise in SLAM. Simulation and experiment results exhibit the availability of the proposed SLAM algorithm.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Similar content being viewed by others

References

  1. M. Ferrera, A. Eudes, J. Moras, M. Sanfourche, and G. L. Besnerais, “OV2 SLAM: A fully online and versatile visual SLAM for real-time applications,” IEEE Robotics and Automation Letters, vol. 6, no.2, pp. 1399–1406, February 2021.

    Article  Google Scholar 

  2. H. Alazki, E. Hernández, J. M. Ibarra, and A. Poznyak, “Attractive ellipsoid method controller under noised measurements for SLAM,” International Journal of Control, Automation, and Systems, vol. 15, no. 6, pp. 2764–2775, December 2017.

    Article  Google Scholar 

  3. M. Abouzahir, A. Elouardi, R. Latif, S. Bouaziz, and A. Tajer, “Embedding SLAM algorithms: Has it come of age?” Robotics and Autonomous Systems, vol. 100, pp. 14–26, February 2018.

    Article  Google Scholar 

  4. S. Wen, X. Chen, C. Ma, H. K. Lam, and S. Hua, “The Q-learning obstacle avoidance algorithm based on EKF-SLAM for NAO autonomous walking under unknown environments,” Robotics and Autonomous Systems, vol. 72, pp. 29–36, October 2015.

    Article  Google Scholar 

  5. K. Joo, P. Kim, M. Hebert, I. S. Kweon, and H. J. Kim, “Linear RGB-D SLAM for structured environments,” IEEE Transactions on Pattern Analysis and Machine Intelligence, vol. 44, no. 11, pp. 8403–8419, November 2022.

    PubMed  Google Scholar 

  6. A. Chatterjee and F. Matsuno, “A neuro-fuzzy assisted extended Kalman filter-based approach for simultaneous localization and mapping (SLAM) problems,” IEEE Transactions on Fuzzy Systems, vol. 15, no. 5, pp. 984–997, October 2007.

    Article  Google Scholar 

  7. R. Wang, Z. Chen, F. Yin, and Q. Zhang, “Distributed particle filter based speaker tracking in distributed microphone networks under non-Gaussian noise environments,” Digital Signal Processing, vol. 63, pp. 112–122, April 2017.

    Article  Google Scholar 

  8. K. Konolige and M. Agrawal, “FrameSLAM: From bundle adjustment to real-time visual mapping,” IEEE Transactions on Robotics, vol. 24, no. 5, pp. 1066–1077, October 2008.

    Article  Google Scholar 

  9. R. Smith, M. Self, and P. Cheeseman, “Estimating uncertain spatial relationships in robotics,” Machine Intelligence and Pattern Recognition, vol. 5, no. 5, pp. 435–461, 1988.

    Google Scholar 

  10. S. J. Julier, J. K. Uhlmann, and H. F. Durrant-Whyte, “A new approach for filtering nonlinear systems,” IEEE American Control Conference, pp. 1628–1632, June 1995.

  11. W. Liu, P. P. Pokharel, and J. C. Principe, “Correntropy: Properties and applications in non-Gaussian signal processing,” IEEE Transactions on Signal Processing, vol. 55, no. 11, pp. 5286–5298, October 2007.

    Article  ADS  MathSciNet  Google Scholar 

  12. B. Chen, X. Liu, H. Zhao, J. Qin, and J. Cao, “Maximum correntropy Kalman filter,” Automatica, vol. 76, pp. 70–77, February 2017.

    Article  MathSciNet  Google Scholar 

  13. X. Liu, B. Chen, B. Xu, Z. Wu, and P. Honeine, “Maximum correntropy unscented filter,” International Journal of Systems Science, vol. 48, no. 8, pp. 1607–1615, January 2017.

    Article  MathSciNet  Google Scholar 

  14. B. Chen, L. Xing, H. Zhao, N. Zheng, and J. C. Principe, “Generalized correntropy for robust adaptive filtering,” IEEE Transactions on Signal Processing, vol. 64, no. 13, pp. 3376–3387, July 2016.

    Article  ADS  MathSciNet  Google Scholar 

  15. M. Montemerlo and S. Thrun, “Simultaneous localization and mapping with unknown data association using FastSLAM,” Proc. of IEEE International Conference on Robotics and Automation, vol. 2, pp. 1985–1991, September 2003.

    Google Scholar 

  16. M. Montemerlo, FastSLAM: A Factored Solution to the Simultaneous Localization and Mapping Problem with Unknown Data Association, Ph.D. Dissertation, Carnegie Mellon University, USA, 2003.

    Google Scholar 

  17. C. Kim, R. Sakthivel, and W. K. Chung, “Unscented FastSLAM: A robust and efficient solution to the SLAM problem,” IEEE Transactions on Robotics, vol. 24, no. 4, pp. 808–820, August 2008.

    Article  Google Scholar 

  18. D. Liu, J. Duan, and H. Shi, “A strong tracking square root central difference FastSLAM for unmanned intelligent vehicle with adaptive partial systematic resampling,” IEEE Transactions on Intelligent Transportation Systems, vol. 17, no. 11, pp. 3110–3120, April 2016.

    Article  Google Scholar 

  19. M. Tang, Z. Chen, and F. Yin, “An improved H-infinity unscented FastSLAM with adaptive genetic resampling,” Robotics and Autonomous Systems, vol. 134, December 2020, 103661.

  20. R. Havangi, H. D. Taghirad, M. A. Nekoui, and M. Teshnehlab, “A square root unscented FastSLAM with improved proposal distribution and resampling,” IEEE Transactions on Industrial Electronics, vol. 61, no. 5, pp. 2334–2345, May 2014.

    Article  Google Scholar 

  21. M. Lin, C. Yang, and D. Li, “An improved transformed unscented FastSLAM with adaptive genetic resampling,” IEEE Transactions on Industrial Electronics, vol. 66, no. 5, pp. 3583–3594, May 2019.

    Article  Google Scholar 

  22. S. Thrun, W. Burgard, and D. Fox, Probabilistic Robotics, MIT Press, Cambridge, MA, 2005.

    Google Scholar 

  23. A. Sharma, A. Gandhi, A. Kumar, “Estimation of optical model parameters and their correlation matrix using unscented transform Kalman filter technique,” Physics Letters B, vol. 815, 136179, April 2021.

    Article  CAS  Google Scholar 

  24. M. A. Gandhi and L. Mili, “Robust Kalman filter based on a generalized maximum-likelihood-type estimator,” IEEE Transactions on Signal Processing, vol. 58, no. 5, pp. 25092520, May 2010.

    Article  MathSciNet  Google Scholar 

  25. K. R. Shih and S. J. Huang, “Application of a robust algorithm for dynamic state estimation of a power system,” IEEE Transactions on Power Systems, vol. 17, no. 1, pp. 141–147, February 2002.

    Article  ADS  Google Scholar 

  26. Z. Qiu and H. Qian, “Adaptive genetic particle filter and its application to attitude estimation system,” Digital Signal Processing, vol. 81, pp. 163–172, October 2018.

    Article  Google Scholar 

  27. “Matlab Utilities.” [Online] Available: http://www.acfr.usyd.edu.au/homepages/academic/tbailey/software/software.html.

  28. [Online] Available: http://www-personal.acfr.usyd.edu.au/nebot/dataset.htm.

Download references

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Fuliang Yin.

Ethics declarations

We declare that we do not have any commercial or associative interest that represents a conflict of interest in connection with the work submitted.

Additional information

Publisher’s Note Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.

This work was supported by National Natural Science Foundation of China (Nos.62271103,61871066), National High Technology Research and Development Program (863 Program) of China (No.2015AA016306), Natural Science Foundation of Liaoning Province of China (No.20170540159), Fundamental Research Funds for the Central Universities of China (No.DUT17LAB04), Basic Scientific Research Program for Educational Department of Liaoning Province of China (No. JYTQN2023264), Doctoral Initiation Scientific Research Program for Liaoning Normal University of China (No. 2023BSL013), and Provincial Innovation and Entrepreneurship Training Plan Program for Undergraduate of Liaoning Province of China (No. S202310165019).

Ming Tang received his B.S. degree in electronic information engineering, and an M.S. degree in optics from Liaoning Normal University (LNNU), Dalian, China, in 2012 and 2016, respectively, and a Ph.D. degree in signal and information processing from Dalian University of Technology (DUT), Dalian, China, in 2022. He joined the Department of Electronic Information Engineering, LNNU, as a Lecturer since 2022. His research interests include image processing, robot localization and tracking.

Zhe Chen received his B.S. degree in electronic engineering, M.S. and Ph.D. degrees in signal and information processing from Dalian University of Technology (DUT), Dalian, China, in 1996, 1999 and 2003, respectively. He joined the Department of Electronic Engineering, DUT, as a lecturer in 2002, became an associate professor in 2006, and has been a professor since 2017. His research interests include speech processing, image processing, and wideband wireless communication.

Fuliang Yin was born in Fushun city, Liaoning province, China, in 1962. He received his B.S. degree in electronic engineering and an M.S. degree in communications and electronic systems from Dalian University of Technology (DUT), Dalian, China, in 1984 and 1987, respectively. He joined the Department of Electronic Engineering, DUT, as a Lecturer in 1987 and became an Associate Professor in 1991. He has been a Professor at DUT since 1994, and the Dean of the School of Electronic and Information Engineering of DUT from 2000 to 2009. His research interests include speech processing, image processing, and broadband wireless communication.

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Tang, M., Chen, Z. & Yin, F. An Improved UFastSLAM With Generalized Correntropy Loss and Adaptive Genetic Resampling. Int. J. Control Autom. Syst. 22, 976–988 (2024). https://doi.org/10.1007/s12555-022-0535-4

Download citation

  • Received:

  • Revised:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s12555-022-0535-4

Keywords

Navigation