Randomized multi-modal motion planning for a humanoid robot manipulation task

Robots that perform complex manipulation tasks must be able to generate strategies that make and break contact with the object. This requires reasoning in a motion space with a particular multi-modal structure, in which the state contains both a discrete mode (the contact state) and a continuous configuration (the robot and object poses). In this paper we address multi-modal motion planning in the common setting where the state is high-dimensional, and there are a continuous infinity of modes. We present a highly general algorithm, Random-MMP, that repeatedly attempts mode switches sampled at random. A major theoretical result is that Random-MMP is formally reliable and scalable, and its running time depends on certain properties of the multi-modal structure of the problem that are not explicitly dependent on dimensionality. We apply the planner to a manipulation task on the Honda humanoid robot, where the robot is asked to push an object to a desired location on a cluttered table, and the robot is restricted to switch between walking, reaching, and pushing modes. Experiments in simulation and on the real robot demonstrate that Random-MMP solves problem instances that require several carefully chosen pushes in minutes on a PC.

[1]  W. Hoeffding.  Probability Inequalities for sums of Bounded Random Variables , 1963 .

[2]  James M. Ortega,et al.  Iterative solution of nonlinear equations in several variables , 2014, Computer science and applied mathematics.

[3]  D. Vere-Jones.  Markov Chains , 1972, Nature.

[4]  Matthew T. Mason,et al.  Mechanics and Planning of Manipulator Pushing Operations , 1986 .

[5]  Arthur C. Sanderson,et al.  The motion of a pushed, sliding workpiece , 1988, IEEE J. Robotics Autom..

[6]  Randall H. Wilson,et al.  On geometric assembly planning , 1992 .

[7]  Jean-Claude Latombe,et al.  On multi-arm manipulation planning , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[8]  Jean-Claude Latombe,et al.  Geometric Reasoning About Mechanical Assembly , 1994, Artif. Intell..

[9]  Rachid Alami,et al.  Two manipulation planning algorithms , 1995 .

[10]  Jean-Daniel Boissonnat,et al.  Motion planning of legged robots: the spider robot problem , 1995, Int. J. Comput. Geom. Appl..

[11]  Michael S. Branicky,et al.  Studies in hybrid systems: modeling, analysis, and control , 1996 .

[12]  Kevin M. Lynch,et al.  Stable Pushing: Mechanics, Controllability, and Planning , 1995, Int. J. Robotics Res..

[13]  Rajeev Motwani,et al.  Path planning in expansive configuration spaces , 1997, Proceedings of International Conference on Robotics and Automation.

[14]  Jérôme Barraquand,et al.  A method of progressive constraints for manipulation planning , 1997, IEEE Trans. Robotics Autom..

[15]  Moëz Cherif,et al.  Planning for in-hand dextrous manipulation , 1998 .

[16]  F. Bullo,et al.  On modeling and locomotion of hybrid mechanical systems with impacts , 1998, Proceedings of the 37th IEEE Conference on Decision and Control (Cat. No.98CH36171).

[17]  Arancha Casal,et al.  Self-reconfiguration planning for a class of modular robots , 1999, Optics East.

[18]  Ian M. Mitchell,et al.  Level Set Methods for Computation in Hybrid Systems , 2000, HSCC.

[19]  Jing Xiao,et al.  On Random Sampling in Contact Configuration Space , 2000 .

[20]  Jean-Claude Latombe,et al.  Kinodynamic motion planning amidst moving obstacles , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[21]  Lydia E. Kavraki,et al.  A two level fuzzy PRM for manipulation planning , 2000, Proceedings. 2000 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2000) (Cat. No.00CH37113).

[22]  Jean-Claude Latombe,et al.  Reconfiguration planning for modular self-reconfigurable robots , 2001 .

[23]  Lydia E. Kavraki,et al.  Randomized path planning for linkages with closed kinematic chains , 2001, IEEE Trans. Robotics Autom..

[24]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[25]  Francesco Bullo,et al.  Modeling and controllability for a class of hybrid mechanical systems , 2002, IEEE Trans. Robotics Autom..

[26]  Thierry Siméon,et al.  A General Manipulation Task Planner , 2002, WAFR.

[27]  Jean-Claude Latombe,et al.  Randomized Kinodynamic Motion Planning with Moving Obstacles , 2002, Int. J. Robotics Res..

[28]  Masayuki Inaba,et al.  Dynamically-Stable Motion Planning for Humanoid Robots , 2002, Auton. Robots.

[29]  Jean-Claude Latombe,et al.  On Delaying Collision Checking in PRM Planning: Application to Multi-Robot Coordination , 2002, Int. J. Robotics Res..

[30]  Hideya Yamaguchi,et al.  Dynamic motion planning whole arm grasp systems based on switching contact modes , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[31]  Joel W. Burdick,et al.  Motion planning for kinematic stratified systems with application to quasi-static legged locomotion and finger gaiting , 2002, IEEE Trans. Robotics Autom..

[32]  J. Chestnutt,et al.  Planning Biped Navigation Strategies in Complex Environments , 2003 .

[33]  Thierry Siméon,et al.  Eurographics/siggraph Symposium on Computer Animation (2003) Visual Simulation of Ice Crystal Growth , 2022 .

[34]  Timothy Bretl,et al.  Multi-Step Motion Planning for Free-Climbing Robots , 2004, WAFR.

[35]  Thierry Siméon,et al.  Sampling-Based Motion Planning under Kinematic Loop-Closure Constraints , 2004, WAFR.

[36]  Thierry Siméon,et al.  Manipulation Planning with Probabilistic Roadmaps , 2004, Int. J. Robotics Res..

[37]  Timothy Bretl,et al.  Non-gaited humanoid locomotion planning , 2005, 5th IEEE-RAS International Conference on Humanoid Robots, 2005..

[38]  Mark H. Overmars,et al.  An Effective Framework for Path Planning Amidst Movable Obstacles , 2006, WAFR.

[39]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[40]  Timothy Bretl,et al.  Motion Planning of Multi-Limbed Robots Subject to Equilibrium Constraints: The Free-Climbing Robot Problem , 2006, Int. J. Robotics Res..

[41]  Mike Stilman,et al.  Navigation among movable obstacles , 2007 .

[42]  Mark H. Overmars,et al.  Creating High-quality Paths for Motion Planning , 2007, Int. J. Robotics Res..

[43]  Dieter Schmalstieg,et al.  ARToolKitPlus for Pose Trackin on Mobile Devices , 2007 .

[44]  Héctor H. González-Baños,et al.  Multi-modal Motion Planning for a Humanoid Robot Manipulation Task , 2007, ISRR.

[45]  Timothy Bretl,et al.  Motion Planning for Legged Robots on Varied Terrain , 2008, Int. J. Robotics Res..

[46]  Dinesh Manocha,et al.  Path Planning among Movable Obstacles: A Probabilistically Complete Approach , 2008, WAFR.

[47]  Rachid Alami,et al.  A Hybrid Approach to Intricate Motion, Manipulation and Task Planning , 2009, Int. J. Robotics Res..

[48]  Victor Ng-Thow-Hing,et al.  Fast smoothing of manipulator trajectories using optimal bounded-acceleration shortcuts , 2010, 2010 IEEE International Conference on Robotics and Automation.

[49]  Jean-Claude Latombe,et al.  Multi-modal Motion Planning in Non-expansive Spaces , 2010, Int. J. Robotics Res..

[50]  Zexiang Li,et al.  Sampling-based finger gaits planning for multifingered robotic hand , 2010, Auton. Robots.