Accurate and robust localization for walking robots fusing kinematics, inertial, vision and LIDAR

In this article, we review methods for localization and situational awareness of biped and quadruped robotics. This type of robot is modelled as a free-floating mechanical system subject to external forces and constrained by whole-body distributed rigid contacts. Measurements of the state of the robot can be made using a variety of sensor information—such as kinematics (the sensing of the joint angles of the robot), contact force (pressure sensors in the robot's feet), accelerometers and gyroscopes as well as external sensors such as vision and LIDAR. This high-frequency state estimate is then passed to the control system of the robot to allow it to traverse terrain or manipulate its environment. In this article, we describe the development of an estimator for the Boston Dynamics Atlas humanoid robot. It was later adapted to the HyQ2 quadruped, developed by the Istituto Italiano di Tecnologia. Some discussion is given as to future trends while also considering briefly the relationship with biological systems.

[1]  Daniel D. Lee,et al.  Proprioceptive localilzatilon for a quadrupedal robot on known terrain , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[2]  Darwin G. Caldwell,et al.  Onboard perception-based trotting and crawling with the Hydraulic Quadruped Robot (HyQ) , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[4]  Nicholas Roy,et al.  State estimation for aggressive flight in GPS-denied environments using onboard sensing , 2012, 2012 IEEE International Conference on Robotics and Automation.

[5]  Olivier Stasse,et al.  Real-time 3D SLAM for Humanoid Robot considering Pattern Generator Information , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Robin Deits,et al.  Computing Large Convex Regions of Obstacle-Free Space Through Semidefinite Programming , 2014, WAFR.

[7]  Benjamin J. Stephens State estimation for force-controlled humanoid balance using simple models in the presence of modeling error , 2011, 2011 IEEE International Conference on Robotics and Automation.

[8]  Scott Kuindersma,et al.  An efficiently solvable quadratic program for stabilizing dynamic locomotion , 2013, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[9]  Paul J. Besl,et al.  A Method for Registration of 3-D Shapes , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[10]  Luke Fletcher,et al.  Simultaneous local and global state estimation for robotic navigation , 2009, 2009 IEEE International Conference on Robotics and Automation.

[11]  Darwin G. Caldwell,et al.  Probabilistic Contact Estimation and Impact Detection for State Estimation of Quadruped Robots , 2017, IEEE Robotics and Automation Letters.

[12]  Roland Siegwart,et al.  State Estimation for Legged Robots - Consistent Fusion of Leg Kinematics and IMU , 2012, Robotics: Science and Systems.

[13]  Roland Siegwart,et al.  Unsupervised identification and prediction of foothold robustness , 2013, 2013 IEEE International Conference on Robotics and Automation.

[14]  Scott Kuindersma,et al.  An Architecture for Online Affordance‐based Perception and Whole‐body Planning , 2015, J. Field Robotics.

[15]  Seth J. Teller,et al.  Drift-free humanoid state estimation fusing kinematic, inertial and LIDAR sensing , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

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

[17]  Roy Featherstone,et al.  Robot Dynamics Algorithms , 1987 .

[18]  Simona Nobili,et al.  Heterogeneous Sensor Fusion for Accurate State Estimation of Dynamic Legged Robots , 2017, Robotics: Science and Systems.

[19]  Kurt Konolige,et al.  The Office Marathon: Robust navigation in an indoor office environment , 2010, 2010 IEEE International Conference on Robotics and Automation.

[20]  Darwin G. Caldwell,et al.  A reactive controller framework for quadrupedal locomotion on challenging terrain , 2013, 2013 IEEE International Conference on Robotics and Automation.

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

[22]  Weiwei Huang,et al.  Decoupled state estimation for humanoids using full-body dynamics , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[23]  Wolfram Burgard,et al.  OctoMap : A Probabilistic , Flexible , and Compact 3 D Map Representation for Robotic Systems , 2010 .

[24]  Nicholas Rotella,et al.  State estimation for a humanoid robot , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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