Monte Carlo Localization for Humanoid Robot Navigation in Complex Indoor Environments

Accurate and reliable localization is a prerequisite for autonomously performing high-level tasks with humanoid robots. In this paper, we present a probabilistic localization method for humanoid robots navigating in arbitrary complex indoor environments using only onboard sensing, which is a challenging task. Inaccurate motion execution of biped robots leads to an uncertain estimate of odometry, and their limited payload constrains perception to observations from lightweight and typically noisy sensors. Additionally, humanoids do not walk on flat ground only and perform a swaying motion while walking, which requires estimating a full 6D torso pose. We apply Monte Carlo localization to globally determine and track a humanoid's 6D pose in a given 3D world model, which may contain multiple levels and staircases. We present an observation model to integrate range measurements from a laser scanner or a depth camera as well as attitude data and information from the joint encoders. To increase the localization accuracy, e.g., while climbing stairs, we propose a further observation model and additionally use monocular vision data in an improved proposal distribution. We demonstrate the effectiveness of our methods in extensive real-world experiments with a Nao humanoid. As the experiments illustrate, the robot is able to globally localize itself and accurately track its 6D pose while walking and climbing stairs.

[1]  Wolfram Burgard,et al.  A visual odometry framework robust to motion blur , 2009, 2009 IEEE International Conference on Robotics and Automation.

[2]  Takeo Kanade,et al.  Online environment reconstruction for biped navigation , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[3]  Satoshi Kagami,et al.  Biped navigation in rough environments using on-board sensing , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  Wolfram Burgard,et al.  Monte Carlo localization for mobile robots , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[5]  Maren Bennewitz,et al.  Learning reliable and efficient navigation with a humanoid , 2010, 2010 IEEE International Conference on Robotics and Automation.

[6]  G. Schmidt,et al.  Experiments in Vision-Guided Robot Walking in a Structured Scenario , 2005, Proceedings of the IEEE International Symposium on Industrial Electronics, 2005. ISIE 2005..

[7]  Wolfram Burgard,et al.  Efficient grid-based spatial representations for robot navigation in dynamic environments , 2013, Robotics Auton. Syst..

[8]  Maren Bennewitz,et al.  Humanoid robot localization in complex indoor environments , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[9]  SungHwan Ahn,et al.  On-board odometry estimation for 3D vision-based SLAM of humanoid robot , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Wolfram Burgard,et al.  Improved Techniques for Grid Mapping With Rao-Blackwellized Particle Filters , 2007, IEEE Transactions on Robotics.

[11]  Daniel Maier,et al.  Real-time navigation in 3D environments based on depth camera data , 2012, 2012 12th IEEE-RAS International Conference on Humanoid Robots (Humanoids 2012).

[12]  Olivier Stasse,et al.  3D grid and particle based SLAM for a humanoid robot , 2009, 2009 9th IEEE-RAS International Conference on Humanoid Robots.

[13]  Wolfram Burgard,et al.  Metric Localization with Scale-Invariant Visual Features Using a Single Perspective Camera , 2006, EUROS.

[14]  Masahiro Fujita,et al.  3D Perception and Environment Map Generation for Humanoid Robot Navigation , 2008, Int. J. Robotics Res..

[15]  Satoshi Kagami,et al.  Localisation for Autonomous Humanoid Navigation , 2006, 2006 6th IEEE-RAS International Conference on Humanoid Robots.

[16]  Sander Oude Elberink,et al.  Accuracy and Resolution of Kinect Depth Data for Indoor Mapping Applications , 2012, Sensors.

[17]  Günther Schmidt,et al.  Intelligent gaze control for vision-guided humanoid walking: methodological aspects , 2004, Robotics Auton. Syst..

[18]  Takeo Kanade,et al.  GPU-accelerated real-time 3D tracking for humanoid locomotion and stair climbing , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  Sebastian Thrun,et al.  A Probabilistic On-Line Mapping Algorithm for Teams of Mobile Robots , 2001, Int. J. Robotics Res..

[20]  Sven Behnke,et al.  The humanoid museum tour guide Robotinho , 2009, RO-MAN 2009 - The 18th IEEE International Symposium on Robot and Human Interactive Communication.

[21]  Olivier Stasse,et al.  How to localize humanoids with a single camera? , 2013, Auton. Robots.

[22]  Satoshi Kagami,et al.  Planning and Executing Navigation Among Movable Obstacles , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[23]  Ronald Parr,et al.  Learning probabilistic motion models for mobile robots , 2004, ICML.

[24]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

[25]  Wolfram Burgard,et al.  Monte Carlo localization in outdoor terrains using multilevel surface maps , 2008, J. Field Robotics.

[26]  Olivier Stasse,et al.  Integrating Walking and Vision to Increase Humanoid Autonomy , 2008, Int. J. Humanoid Robotics.

[27]  Satoshi Kagami,et al.  Autonomous navigation of a humanoid robot over unknown rough terrain using a laser range sensor , 2012, Int. J. Robotics Res..

[28]  Maren Bennewitz,et al.  Improved proposals for highly accurate localization using range and vision data , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[29]  Wolfram Burgard,et al.  OctoMap: an efficient probabilistic 3D mapping framework based on octrees , 2013, Autonomous Robots.

[30]  Wolfram Burgard,et al.  Monte Carlo localization in outdoor terrains using multilevel surface maps , 2008 .

[31]  Maren Bennewitz,et al.  From 3D point clouds to climbing stairs: A comparison of plane segmentation approaches for humanoids , 2011, 2011 11th IEEE-RAS International Conference on Humanoid Robots.

[32]  Simon J. Godsill,et al.  On sequential Monte Carlo sampling methods for Bayesian filtering , 2000, Stat. Comput..

[33]  Wolfram Burgard,et al.  How to learn accurate grid maps with a humanoid , 2008, 2008 IEEE International Conference on Robotics and Automation.

[34]  Francesco Ferro,et al.  Autonomous humanoid navigation using laser and odometry data , 2008, Humanoids 2008 - 8th IEEE-RAS International Conference on Humanoid Robots.

[35]  Tsukasa Ogasawara,et al.  Indoor Navigation for a Humanoid Robot Using a View Sequence , 2009, Int. J. Robotics Res..