Regrasp Planning Considering Bipedal Stability Constraints

This paper presents a Center of Mass (CoM) based manipulation and regrasp planner that implements stability constraints to preserve the robot balance. The planner provides a graph of IK-feasible, collision-free and stable motion sequences, constructed using an energy based motion planning algorithm. It assures that the assembly motions are stable and prevent the robot from falling while performing dexterous tasks in different situations. Furthermore, the constraints are also used to perform an RRT-inspired task-related stability estimation in several simulations. The estimation can be used to select between single-arm and dual-arm regrasping configurations to achieve more stability and robustness for a given manipulation task. To validate the planner and the task-related stability estimations, several tests are performed in simulations and real-world experiments involving the HRP5P humanoid robot, the 5th generation of the HRP robot family. The experiment results suggest that the planner and the task-related stability estimation provide robust behavior for the humanoid robot while performing regrasp tasks.

[1]  R. McGhee,et al.  On the stability properties of quadruped creeping gaits , 1968 .

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

[3]  Olivier Stasse,et al.  TALOS: A new humanoid research platform targeted for industrial applications , 2017, 2017 IEEE-RAS 17th International Conference on Humanoid Robotics (Humanoids).

[4]  Christopher M. Schlick,et al.  Design and comparative evaluation of an iterative contact point estimation method for static stability estimation of mobile actively reconfigurable robots , 2015, Robotics Auton. Syst..

[5]  Bernd Henze,et al.  Posture and balance control for humanoid robots in multi-contact scenarios based on Model Predictive Control , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Tucker Hermans,et al.  Geometric In-Hand Regrasp Planning: Alternating Optimization of Finger Gaits and In-Grasp Manipulation , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[7]  Kenji KANEKO,et al.  Humanoid robot HRP-3 , 2004, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[8]  Patrick A. O'Donnell,et al.  HANDEY: A Robot Task Planner , 1992 .

[9]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[10]  Mike Stilman,et al.  Golem Krang: Dynamically stable humanoid robot for mobile manipulation , 2010, 2010 IEEE International Conference on Robotics and Automation.

[11]  Kensuke Harada,et al.  Reorientating objects with a gripping hand and a table surface , 2015, 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids).

[12]  Bernd Henze,et al.  Good Posture, Good Balance: Comparison of Bioinspired and Model-Based Approaches for Posture Control of Humanoid Robots , 2016, IEEE Robotics & Automation Magazine.

[13]  David E. Orin,et al.  Interactive control of a six-legged vehicle with optimization of both stability and energy / , 1976 .

[14]  Dmitry Berenson,et al.  No falls, no resets: Reliable humanoid behavior in the DARPA robotics challenge , 2015, 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids).

[15]  Kensuke Harada,et al.  Developing and Comparing Single-Arm and Dual-Arm Regrasp , 2015, IEEE Robotics and Automation Letters.

[16]  Twan Koolen,et al.  Balance control using center of mass height variation: Limitations imposed by unilateral contact , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[17]  Elena García Armada,et al.  A classification of stability margins for walking robots , 2002 .

[18]  Thierry Siméon,et al.  Transition-based RRT for path planning in continuous cost spaces , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  Siddhartha S. Srinivasa,et al.  Manipulation planning on constraint manifolds , 2009, 2009 IEEE International Conference on Robotics and Automation.

[20]  Gabriele Nava,et al.  Stability analysis and design of momentum-based controllers for humanoid robots , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[21]  Nikolaos Papanikolopoulos,et al.  Planning of regrasp operations , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[22]  Suril Vijaykumar Shah,et al.  Optimal whole body motion planning of humanoid with articulated spine for object manipulation in double support phase , 2015, AIR '15.

[23]  Shuuji Kajita,et al.  A Humanoid Robot Carrying a Heavy Object , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[24]  Jörn Malzahn,et al.  WALK‐MAN: A High‐Performance Humanoid Platform for Realistic Environments , 2017, J. Field Robotics.

[25]  Olivier Stasse,et al.  Motion generation for pulling a fire hose by a humanoid robot , 2016, 2016 IEEE-RAS 16th International Conference on Humanoid Robots (Humanoids).

[26]  Mehmet Remzi Dogar,et al.  Manipulation Planning to Keep an Object Stable under a Sequence of External Forces , 2017, ArXiv.

[27]  Nikolaos G. Tsagarakis,et al.  Center-of-Mass-Based Grasp Pose Adaptation Using 3D Range and Force/Torque Sensing , 2018, Int. J. Humanoid Robotics.

[28]  Hirochika Inoue,et al.  HRP: Humanoid Robotics Project of MITI , 2000 .

[29]  Pieter Abbeel,et al.  Motion planning with sequential convex optimization and convex collision checking , 2014, Int. J. Robotics Res..