New Adaptive UKF Algorithm to Improve the Accuracy of SLAM

Document Type : Original Article


1 Yazd University

2 Department of Mech. Eng., Yazd University

3 School of Mechatronic Systems Engineering, Simon Fraser University 250-13450 102 Avenue, Surrey, BC, V3T 0A3 Canada


SLAM (Simultaneous Localization and Mapping) is a fundamental problem when an autonomous mobile robot explores an unknown environment by constructing/updating the environment map and localizing itself in this built map. The all-important problem of SLAM is revisited in this paper and a solution based on Adaptive Unscented Kalman Filter (AUKF) is presented. We will explain the detailed algorithm and demonstrate that the estimation error is significantly reduced and the accuracy of thenavigation is improved. A comparison among AUKF, Unscented Kalman Filter (UKF) and Extended Kalman Filter (EKF) algorithms is investigated through simulated as well as experimental dataset. An indoor dataset is generated from a two-wheel differential mobile robot in order to validate the robustness of AUKF-SLAM to noise of modeling and observation, and to examine the applicability of the method for real-time navigation. Both experimental and simulation results illustrate that AUKF-SLAM is more accurate than the standard UKF-SLAM and the EKF-SLAM. Finally, the well-known Victoria Park dataset is used to prove the applicability of the AUKF algorithm in large-scale environments.


[1]  J. E. Guivant and E. M. Nebot, "Optimization of the simultaneous localization and map-building algorithm for real-time implementation," Robotics and Automation, IEEE Transactions on, vol. 17, pp. 242-257, 2001.
[2]  G. P. Huang, A. I. Mourikis, and S. I. Roumeliotis, "Analysis and improvement of the consistency of extended Kalman filter based SLAM," in Robotics and Automation, 2008. ICRA 2008. IEEE International Conference on, 2008, pp. 473-479.
[3]  M. Montemerlo, S. Thrun, D. Koller, and B. Wegbreit, "FastSLAM: A factored solution to the simultaneous localization and mapping problem," in AAAI/IAAI, 2002, pp. 593-598.
[4]  V. Elvira, J. Míguez, and P. M. Djurić, "Adapting the number of particles in sequential monte carlo methods through an online scheme for convergence assessment," IEEE Transactions on Signal Processing, vol. 65, pp. 1781-1794, 2017.
[5]  D. Simon, Optimal state estimation: Kalman, H infinity, and nonlinear approaches: John Wiley & Sons, 2006.
[6]  R. Martinez-Cantin and J. Castellanos, "Unscented SLAM for large-scale outdoor environments," in Intelligent Robots and Systems, IEEE/RSJ International Conference on, 2005, pp. 3427-3432.
[7]  N. Sunderhauf, S. Lange, and P. Protzel, "Using the unscented kalman filter in mono-SLAM with inverse depth parametrization for autonomous airship control," in Safety, Security and Rescue Robotics, 2007. SSRR 2007. IEEE International Workshop on, 2007, pp. 1-6.
[8]  G. P. Huang, A. Mourikis, and S. Roumeliotis, "On the complexity and consistency of UKF-based SLAM," in Robotics and Automation, IEEE International Conference on, 2009, pp. 4401-4408.
[9]  G. Shao, L. Wan, and X. D. Shen, "Hierarchical map building based UKF-SLAM approach for AUV," in Applied Mechanics and Materials, 2013, pp. 793-797.
[10]   M. Wu and Y. Weng, "UKF-SLAM based gravity gradient aided navigation," in Intelligent Robotics and Applications, ed: Springer, 2014, pp. 77-88.
[11]   S. Maeyama, Y. Takahashi, and K. Watanabe, "A solution to SLAM problems by simultaneous estimation of kinematic parameters including sensor mounting offset with an augmented UKF," Advanced Robotics, vol. 29, pp. 1137-1149, 2015.
[12]   T. S. Ho, Y. C. Fai, and E. S. L. Ming, "Simultaneous localization and mapping survey based on filtering techniques," in Control Conference, 10th Asian, 2015, pp. 1-6.
[13]   C. Cadena, L. Carlone, H. Carrillo, Y. Latif, D. Scaramuzza, J. Neira, et al., "Past, present, and future of simultaneous localization and mapping: toward the robust-perception age," IEEE Transactions on Robotics, vol. 32, pp. 1309-1332, 2016.
[14]   N. H. Khan and A. Adnan, "Ego-motion estimation concepts, algorithms and challenges: an overview," Multimedia Tools and Applications, pp. 1-23, 2016.
[15]   M. S. Bahraini, M. Bozorg, and A. B. Rad, "SLAM in dynamic environments via ML-RANSAC," Mechatronics, vol. 49, pp. 105-118, 2018.
[16]   M. Cugliari and F. Martinelli, "A FastSLAM algorithm based on the Unscented Filtering with adaptive selective resampling," in Field and Service Robotics, 2008, pp. 359-368.
[17]   J. Qi, D. Song, C. Wu, J. Han, and T. Wang, "KF-based adaptive UKF algorithm and its application for rotorcraft UAV actuator failure estimation," Int J Adv Robotic Sy, vol. 9, 2012.
[18]   H. Wang, G. Fu, J. Li, Z. Yan, and X. Bian, "An adaptive UKF based SLAM method for unmanned underwater vehicle," Mathematical Problems in Engineering, vol. 2013, 2013.
[19]   Z.-l. Wang, S. Qin, and Y.-m. Liang, "Adaptive UKF-SLAM Algorithm Based on Noise Scaling," Computer Engineering, vol. 10, p. 029, 2014.
[20]   M. Wu and J. Yao, "Adaptive UKF-SLAM Based on Magnetic Gradient Inversion Method for Underwater Navigation," in Intelligent Robotics and Applications, ed: Springer, 2015, pp. 237-247.
[21]   J. Dunik, M. Simandl, and O. Straka, "Unscented Kalman filter: aspects and adaptive setting of scaling parameter," Automatic Control, IEEE Transactions on, vol. 57, pp. 2411-2416, 2012.
[22]   L. A. Scardua and J. J. da Cruz, "Adaptively tuning the scaling parameter of the unscented kalman filter," in Proceedings of the 11th Portuguese Conference on Automatic Control, 2015, pp. 429-438.
[23]   O. Straka, J. Dunik, M. Simandl, and E. Blasch, "Comparison of adaptive and randomized unscented Kalman filter algorithms," in Information Fusion, 17th International Conference on, 2014, pp. 1-8.
[24]   O. Straka, J. Dunik, and M. Simandl, "Unscented Kalman filter with advanced adaptation of scaling parameter," Automatica, vol. 50, pp. 2657-2664, 2014.
[25]   J. Guivant, J. Nieto, and E. Nebot, "Victoria park dataset," ed, 2012.
[26]   S. J. Julier and J. K. Uhlmann, "Unscented filtering and nonlinear estimation," Proceedings of the IEEE, vol. 92, pp. 401-422, 2004.
[27]   S. Julier, J. Uhlmann, and H. F. Durrant-Whyte, "Technical Notes and Correspondence_," IEEE Transactions on automatic control, vol. 45, p. 477, 2000.
[28]   O. Straka, J. Dunik, and M. Simandl, "Scaling parameter in unscented transform: Analysis and specification," in American Control Conference (ACC), 2012, 2012, pp. 5550-5555.
[29]   T. Bailey, "Mobile robot localisation and mapping in extensive outdoor environments," Diss. The University of Sydney, 2002.
[30]   T. Bailey, J. Nieto, J. Guivant, M. Stevens, and E. Nebot, "Consistency of the EKF-SLAM algorithm," in Intelligent Robots and Systems, 2006 IEEE/RSJ International Conference on, 2006, pp. 3562-3568.
[31]   Y. Tu, Z. Huang, X. Zhang, W. Yu, Y. Xu, and B. Chen, "The Mobile Robot SLAM Based on Depth and Visual Sensing in Structured Environment," in Robot Intelligence Technology and Applications 3, ed: Springer, 2015, pp. 343-357