Humanoid manipulation planning using backward-forward search

This paper explores combining task and manipulation planning for humanoid robots. Existing methods tend to either take prohibitively long to compute for humanoids or artificially limit the physical capabilities of the humanoid platform by restricting the robot's actions to predetermined trajectories. We present a hybrid planning system which is able to scale well for complex tasks without relying on predetermined robot actions. Our system utilizes the hybrid backward-forward planning algorithm for high-level task planning combined with humanoid primitives for standing and walking motion planning. These primitives are designed to be efficiently computable during planning, despite the large amount of complexity present in humanoid robots, while still informing the task planner of the geometric constraints present in the problem. Our experiments apply our method to simulated pick-and-place problems with additional gate constraints impacting navigation using the DRC-HUBO1 robot. Our system is able to solve puzzle-like problems on a humanoid within a matter of minutes.

[1]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[2]  Michael Gienger,et al.  Task-oriented whole body motion for humanoid robots , 2005, 5th IEEE-RAS International Conference on Humanoid Robots, 2005..

[3]  Miomir Vukobratovic,et al.  Zero-Moment Point - Thirty Five Years of its Life , 2004, Int. J. Humanoid Robotics.

[4]  Andrea Lockerd Thomaz,et al.  Work those arms: Toward dynamic and stable humanoid walking that optimizes full-body motion , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[5]  Aaron D. Ames,et al.  3D dynamic walking with underactuated humanoid robots: A direct collocation framework for optimizing hybrid zero dynamics , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[6]  Aaron D. Ames,et al.  Towards the Unification of Locomotion and Manipulation through Control Lyapunov Functions and Quadratic Programs , 2013, CPSW@CISS.

[7]  Satoshi Kagami,et al.  Planning and executing navigation among movable obstacles , 2007, Adv. Robotics.

[8]  Masayuki Inaba,et al.  Online footstep planning for humanoid robots , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[9]  Oussama Khatib,et al.  A whole-body control framework for humanoids operating in human environments , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[10]  Aaron Hertzmann,et al.  Style-based inverse kinematics , 2004, SIGGRAPH 2004.

[11]  Leslie Pack Kaelbling,et al.  FFRob: An Efficient Heuristic for Task and Motion Planning , 2015, WAFR.

[12]  Yoshihiko Nakamura,et al.  Whole-body cooperative balancing of humanoid robot using COG Jacobian , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  Eiichi Yoshida,et al.  Task-driven Support Polygon Reshaping for Humanoids , 2006, 2006 6th IEEE-RAS International Conference on Humanoid Robots.

[14]  Aaron Hertzmann,et al.  Style-based inverse kinematics , 2004, ACM Trans. Graph..

[15]  Jean-Claude Latombe,et al.  Integrating task and PRM motion planning : Dealing with many infeasible motion planning queries , 2009 .

[16]  Siddhartha S. Srinivasa,et al.  Task Space Regions , 2011, Int. J. Robotics Res..

[17]  Katsu Yamane,et al.  Natural Motion Animation through Constraining and Deconstraining at Will , 2003, IEEE Trans. Vis. Comput. Graph..

[18]  Malte Helmert,et al.  The Fast Downward Planning System , 2006, J. Artif. Intell. Res..

[19]  Dmitry Berenson,et al.  A robot path planning framework that learns from experience , 2012, 2012 IEEE International Conference on Robotics and Automation.

[20]  Jun Nakanishi,et al.  Inverse kinematics with floating base and constraints for full body humanoid robot control , 2008, Humanoids 2008 - 8th IEEE-RAS International Conference on Humanoid Robots.

[21]  Pieter Abbeel,et al.  Combined task and motion planning through an extensible planner-independent interface layer , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[22]  C. K. Liu,et al.  A Quick Tutorial on Multibody Dynamics , 2012 .

[23]  Caelan Reed Garrett,et al.  Backward-Forward Search for Manipulation Planning Completeness Argument , 2015 .