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.
Similar content being viewed by others
References
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.
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.
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.
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.
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.
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.
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.
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.
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.
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.
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.
B. Chen, X. Liu, H. Zhao, J. Qin, and J. Cao, “Maximum correntropy Kalman filter,” Automatica, vol. 76, pp. 70–77, February 2017.
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.
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.
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.
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.
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.
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.
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.
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.
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.
S. Thrun, W. Burgard, and D. Fox, Probabilistic Robotics, MIT Press, Cambridge, MA, 2005.
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.
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.
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.
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.
“Matlab Utilities.” [Online] Available: http://www.acfr.usyd.edu.au/homepages/academic/tbailey/software/software.html.
[Online] Available: http://www-personal.acfr.usyd.edu.au/nebot/dataset.htm.
Author information
Authors and Affiliations
Corresponding author
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
About this article
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
Received:
Revised:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s12555-022-0535-4