Synthesis of Energy-Bounded Planar Caging Grasps Using Persistent Homology

For applications such as manufacturing, caging grasps restrict object motion without requiring complete immobilization, providing a robust alternative to force- and form-closure grasps. Energy-bounded cages are a new class of caging grasps that relax the requirement of complete caging in the presence of external forces such as gravity or constant velocity pushing in the horizontal plane with Coulomb friction. We address the problem of synthesizing planar energy-bounded cages by identifying gripper and force-direction configurations that maximize the energy required for the object to escape. We present Energy-Bounded-Cage-Synthesis-2-D (EBCS-2-D), a sampling-based algorithm that uses persistent homology, a recently-developed multiscale approach for topological analysis, to efficiently compute candidate rigid configurations of obstacles that form energy-bounded cages of an object from an <inline-formula> <tex-math notation="LaTeX">$\alpha $ </tex-math></inline-formula>-shape approximation to the configuration space. If a synthesized configuration has infinite escape energy then the object is completely caged. EBCS-2-D runs in <inline-formula> <tex-math notation="LaTeX">$O(s^{3} + s n^{2})$ </tex-math></inline-formula> time, where <inline-formula> <tex-math notation="LaTeX">$s$ </tex-math></inline-formula> is the number of samples and <inline-formula> <tex-math notation="LaTeX">$n$ </tex-math></inline-formula> is the number of object and obstacle vertices, where typically <inline-formula> <tex-math notation="LaTeX">$n \ll s$ </tex-math></inline-formula>. We observe runtimes closer to <inline-formula> <tex-math notation="LaTeX">$O(s)$ </tex-math></inline-formula> for fixed <inline-formula> <tex-math notation="LaTeX">$n$ </tex-math></inline-formula>. We implement EBCS-2-D using the persistent homology algorithms toolbox and study performance on a set of seven planar objects and four gripper types. Experiments suggest that EBCS-2-D takes 2–3 min on a 6 core processor with 200 000 pose samples. We also confirm that an rapidly-exploring random tree* motion planner is unable to find escape paths with lower energy. Physical experiments on a five degree of freedom Zymark Zymate and ABB YuMi suggest that push grasps synthesized by EBCS-2-D are robust to perturbations. Data and code are available at <uri>http://berkeleyautomation.github.io/caging/</uri>. <italic>Note to Practitioners</italic>—For automation applications in manufacturing where object models are precisely known, “energy-bounded cages” are a robust approach to robot grasping in the presence of gravity or friction. This paper presents a synthesis algorithm for planar instances, where the object can be modeled as a planar extrusion and the motion occurs in the vertical or horizontal plane. We also present experiments with robots and a website with code and data.

[1]  Rui Fukui,et al.  Efficient Planar Caging Test Using Space Mapping , 2018, IEEE Transactions on Automation Science and Engineering.

[2]  Amir Shapiro,et al.  Caging Polygonal Objects Using Equilateral Three-Finger Hands , 2017, IEEE Robotics and Automation Letters.

[3]  Ulrich Bauer,et al.  Phat - Persistent Homology Algorithms Toolbox , 2014, J. Symb. Comput..

[4]  Anca D. Dragan,et al.  Robot grasping in clutter: Using a hierarchy of supervisors for learning from demonstrations , 2016, 2016 IEEE International Conference on Automation Science and Engineering (CASE).

[5]  Charlie C. L. Wang,et al.  Rope caging and grasping , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[6]  Kenneth Y. Goldberg,et al.  Energy-Bounded Caging: Formal Definition and 2-D Energy Lower Bound Algorithm Based on Weighted Alpha Shapes , 2016, IEEE Robotics and Automation Letters.

[7]  Joel W. Burdick,et al.  Two-Finger Caging of Polygonal Objects Using Contact Space Search , 2015, IEEE Transactions on Robotics.

[8]  Siddhartha S. Srinivasa,et al.  Benchmarking in Manipulation Research: Using the Yale-CMU-Berkeley Object and Model Set , 2015, IEEE Robotics & Automation Magazine.

[9]  Siddhartha S. Srinivasa,et al.  The YCB object and Model set: Towards common benchmarks for manipulation research , 2015, 2015 International Conference on Advanced Robotics (ICAR).

[10]  Danica Kragic,et al.  Data-Driven Topological Motion Planning with Persistent Cohomology , 2015, Robotics: Science and Systems.

[11]  Hong Qiao,et al.  Vision-Based Caging Grasps of Polyhedron-Like Workpieces With a Binary Industrial Gripper , 2015, IEEE Transactions on Automation Science and Engineering.

[12]  Vijay Kumar,et al.  Persistent Homology for Path Planning in Uncertain Environments , 2015, IEEE Transactions on Robotics.

[13]  P. Abbeel,et al.  Benchmarking in Manipulation Research: The YCB Object and Model Set and Benchmarking Protocols , 2015, ArXiv.

[14]  Siddhartha S. Srinivasa,et al.  Pre- and post-contact policy decomposition for planar contact manipulation under uncertainty , 2014, Int. J. Robotics Res..

[15]  Florian T. Pokorny,et al.  Multiscale Topological Trajectory Classification with Persistent Homology , 2014, Robotics: Science and Systems.

[16]  Herbert Edelsbrunner,et al.  Persistent Homology: Theory and Practice , 2013 .

[17]  Thanathorn Phoka,et al.  Measurement framework of partial cage quality based on probabilistic motion planning , 2013, 2013 IEEE International Conference on Robotics and Automation.

[18]  Yasuo Kuniyoshi,et al.  A new “grasping by caging” solution by using eigen-shapes and space mapping , 2013, 2013 IEEE International Conference on Robotics and Automation.

[19]  Danica Kragic,et al.  Grasping objects with holes: A topological approach , 2013, 2013 IEEE International Conference on Robotics and Automation.

[20]  Siddhartha S. Srinivasa,et al.  Physics-Based Grasp Planning Through Clutter , 2012, Robotics: Science and Systems.

[21]  Markus Vincze,et al.  3DNet: Large-scale object class recognition from CAD models , 2012, 2012 IEEE International Conference on Robotics and Automation.

[22]  Timothy Bretl,et al.  Proving path non-existence using sampling and alpha shapes , 2012, 2012 IEEE International Conference on Robotics and Automation.

[23]  Alberto Rodriguez,et al.  From caging to grasping , 2011, Int. J. Robotics Res..

[24]  Siddhartha S. Srinivasa,et al.  A Framework for Push-Grasping in Clutter , 2011, Robotics: Science and Systems.

[25]  Chao Chen,et al.  Persistent Homology Computation with a Twist , 2011 .

[26]  Afra Zomorodian,et al.  Computational topology , 2010 .

[27]  Herbert Edelsbrunner,et al.  Computational Topology - an Introduction , 2009 .

[28]  Gunnar E. Carlsson,et al.  Topology and data , 2009 .

[29]  Siddhartha S. Srinivasa,et al.  Manipulation planning with caging grasps , 2008, Humanoids 2008 - 8th IEEE-RAS International Conference on Humanoid Robots.

[30]  Dinesh Manocha,et al.  Efficient Cell Labelling and Path Non-existence Computation using C-obstacle Query , 2008, Int. J. Robotics Res..

[31]  Alberto Rodriguez,et al.  Two Finger Caging: Squeezing and Stretching , 2008, WAFR.

[32]  A. Frank van der Stappen,et al.  Caging Polygons with Two and Three Fingers , 2008, Int. J. Robotics Res..

[33]  Dinesh Manocha,et al.  Generalized penetration depth computation , 2006, SPM '06.

[34]  Dinesh Manocha,et al.  Fast C-obstacle query computation for motion planning , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[35]  Kenneth Y. Goldberg,et al.  Orienting polygonal parts without sensors , 1993, Algorithmica.

[36]  Matthew T. Mason,et al.  Mechanics of Robotic Manipulation , 2001 .

[37]  Jean Ponce,et al.  A new approach to motion planning for disc-shaped robots manipulating a polygonal object in the plane , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[38]  Douglas C. Giancoli Physics: Principles with Applications , 1999 .

[39]  Jean Ponce,et al.  On grasping and manipulating polygonal objects with disc-shaped robots in the plane , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[40]  Joel W. Burdick,et al.  Mobility of bodies in contact. I. A 2nd-order mobility index for multiple-finger grasps , 1994, IEEE Trans. Robotics Autom..

[41]  Andrew Blake,et al.  Caging 2D bodies by 1-parameter two-fingered gripping systems , 1996, Proceedings of IEEE International Conference on Robotics and Automation.

[42]  Kevin M. Lynch,et al.  Controllability of pushing , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.

[43]  Matthew T. Mason,et al.  Parts orienting by push-aligning , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.

[44]  Richard M. Murray,et al.  A Mathematical Introduction to Robotic Manipulation , 1994 .

[45]  Herbert Edelsbrunner,et al.  Weighted alpha shapes , 1992 .

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

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

[48]  Randy C. Brost Automatic grasp planning in the presence of uncertainty , 1986, Proceedings. 1986 IEEE International Conference on Robotics and Automation.

[49]  H. Edelsbrunner,et al.  Persistent Homology — a Survey , 2022 .