Kalman filter theory based mobile robot pose tracking using occupancy grid maps

In order to perform useful tasks the mobile robot's current pose must be accurately known. Problem of finding and tracking the mobile robot's pose is called localization, and can be global or local. In this paper we address local localisation or mobile robot pose tracking with prerequisites of known starting pose, robot kinematic and world model. Pose tracking is mostly based on odometry, which has the problem of accumulating errors in an unbounded fashion. To overcome this problem sensor fusion is commonly used. This paper describes two methods for calibrated odometry and sonar sensor fusion based on Kalman filter theory and occupancy grid maps as used world model. Namely, we compare the pose tracking or pose estimation performances of both most commonly used nonlinear-model based estimators: extended and unscented Kalman filter. Since occupancy grid maps are used, only sonar range measurement uncertainty has to be considered, unlike feature based maps where an additional uncertainty regarding the feature/range reading assignment must be considered. Thus the numerical complexity is reduced. Experimental results on the Pioneer 2DX mobile robot show similar and improved accuracy for both pose estimation techniques compared to simple odometry.

[1]  I. Petrovic,et al.  Extended Kalman filter based mobile robot pose tracking using occupancy grid maps , 2004, Proceedings of the 12th IEEE Mediterranean Electrotechnical Conference (IEEE Cat. No.04CH37521).

[2]  T. Başar,et al.  A New Approach to Linear Filtering and Prediction Problems , 2001 .

[3]  Edouard Ivanjko,et al.  Improvements of Occupancy Grid Maps by Sonar Data Corrections , 2003 .

[4]  D. C. Lee The Map-Building and Exploration Strategies of A Simple Sonar-Equipped Robot: The Robot , 1996 .

[5]  S. Julier,et al.  A General Method for Approximating Nonlinear Transformations of Probability Distributions , 1996 .

[6]  Kurt Konolige,et al.  Markov Localization using Correlation , 1999, IJCAI.

[7]  Sebastian Thrun,et al.  Online self-calibration for mobile robots , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[8]  S. Haykin Kalman Filtering and Neural Networks , 2001 .

[9]  Antonios Tsourdos,et al.  Mobile robot localisation and navigation using multi-sensor fusion via interval analysis and UKF , 2004 .

[10]  Michael R. M. Jenkin,et al.  Computational principles of mobile robotics , 2000 .

[11]  Gaurav S. Sukhatme,et al.  Robust localization using relative and absolute position estimates , 1999, Proceedings 1999 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human and Environment Friendly Robots with High Intelligence and Emotional Quotients (Cat. No.99CH36289).

[12]  荒木 望 Unscented Kalman Filterの計測への応用に関する研究 , 2007 .

[13]  Liqiang Feng,et al.  Measurement and correction of systematic odometry errors in mobile robots , 1996, IEEE Trans. Robotics Autom..

[14]  Kurt Konolige,et al.  A gradient method for realtime robot control , 2000, Proceedings. 2000 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2000) (Cat. No.00CH37113).

[15]  Hobart R. Everett,et al.  Where am I?" sensors and methods for mobile robot positioning , 1996 .