Global Vision Localization of Indoor Service Robot Based on Improved Iterative Extended Kalman Particle Filter Algorithm

Localization is the primary problem of mobile robot navigation. Monte Carlo localization based on particle filter has better accuracy and is easier to implement, but there is also the problem of particle degradation. In this paper, the iterative extended Kalman filter is optimized by the Levenberg-Marquardt optimization method. An improved particle filter algorithm based on the upon optimized iterative Kalman filter is proposed, and the importance probability density function of the particle filter is generated by the maximum posterior probability estimation of the improved iterative Kalman filter. Simulation results of the improved particle filter algorithm show that the algorithm can approximate the state posterior probability distribution more closely with fewer sampled particles under the premise of ensuring sufficient state estimation accuracy. Meanwhile, the computation is reduced and the real-time performance is enhanced. Finally, the algorithm is validated on the indoor mobile service robot. The experimental results show that the localization algorithm’s accuracy meets requirement for real-time localizing of the restaurant service robot.

[1]  Yasushi Makihara,et al.  Object recognition supported by user interaction for service robots , 2002, Object recognition supported by user interaction for service robots.

[2]  W. Burgard,et al.  Markov Localization for Mobile Robots in Dynamic Environments , 1999, J. Artif. Intell. Res..

[3]  Stanley T. Birchfield,et al.  An inexpensive method for evaluating the localization performance of a mobile robot navigation system , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[4]  Jaerock Kwon,et al.  Vision based localization for multiple mobile robots using low-cost vision sensor , 2015, EIT.

[5]  Jens-Steffen Gutmann,et al.  Markov-Kalman localization for mobile robots , 2002, Object recognition supported by user interaction for service robots.

[6]  Kourosh Khoshelham,et al.  Robust iterated extended Kalman filter algorithm for foot-mounted inertial measurement units/ultrawideband fusion positioning , 2019 .

[7]  Ettore Stella,et al.  A Vision-Based Odometer for Localization of Omnidirectional Indoor Robots , 2020, Sensors.

[8]  Serge Gratton,et al.  On the convergence of a non-linear ensemble Kalman smoother , 2014, Applied Numerical Mathematics.

[9]  Larry D. Hostetler,et al.  The estimation of the gradient of a density function, with applications in pattern recognition , 1975, IEEE Trans. Inf. Theory.

[10]  Jun S. Liu,et al.  Sequential Monte Carlo methods for dynamic systems , 1997 .

[11]  Xin Su,et al.  A Localization Based on Unscented Kalman Filter and Particle Filter Localization Algorithms , 2020, IEEE Access.

[12]  José A. Castellanos,et al.  Robocentric map joining: Improving the consistency of EKF-SLAM , 2007, Robotics Auton. Syst..

[13]  Ricardo Carelli,et al.  Feature Selection Criteria for Real Time EKF-SLAM Algorithm , 2009 .

[14]  Dan Svenstrup,et al.  Monte Carlo methods for dynamical systems , 2009 .

[15]  G. Kitagawa,et al.  The auxiliary iterated extended Kalman particle filter , 2014, Optimization and Engineering.

[16]  Yuming Bo,et al.  Modified iterated extended Kalman particle filter for single satellite passive tracking , 2013 .

[17]  Alireza Mohammad Shahri,et al.  Experimental Study of Iterated Kalman Filters for Simultaneous Localization and Mapping of Autonomous Mobile Robots , 2011, J. Intell. Robotic Syst..

[18]  Sebastian Thrun,et al.  FastSLAM: a factored solution to the simultaneous localization and mapping problem , 2002, AAAI/IAAI.

[19]  F. W. Cathey,et al.  The iterated Kalman filter update as a Gauss-Newton method , 1993, IEEE Trans. Autom. Control..

[20]  Vikram Krishnamurthy,et al.  Derivation of a sawtooth iterated extended Kalman smoother via the AECM algorithm , 2001, IEEE Trans. Signal Process..

[21]  A. R. Stubberud,et al.  A neural extended Kalman filter multiple model tracker , 2003, Oceans 2003. Celebrating the Past ... Teaming Toward the Future (IEEE Cat. No.03CH37492).

[22]  Li Liang-qun,et al.  The iterated extended Kalman particle filter , 2005, IEEE International Symposium on Communications and Information Technology, 2005. ISCIT 2005..

[23]  Sebastian Thrun,et al.  FastSLAM 2.0: An Improved Particle Filtering Algorithm for Simultaneous Localization and Mapping that Provably Converges , 2003, IJCAI.

[24]  Zhuang Fu,et al.  Industrial Robot : An International Journal An autonomous restaurant service robot with high positioning accuracy , 2016 .

[25]  Xinming Li,et al.  Robot target localization and interactive multi-mode motion trajectory tracking based on adaptive iterative learning , 2020, J. Ambient Intell. Humaniz. Comput..

[26]  Ilshat Mamaev,et al.  Adaptive particle filter for localization problem in service robotics , 2018 .