Efficient Planar Caging Test Using Space Mapping

This paper presents an efficient algorithm to test whether a planar object can be caged by a formation of point agents (point fingertips or point mobile robots). The algorithm is based on a space mapping between the 2-D work space (<inline-formula> <tex-math notation="LaTeX">$\mathcal {W}$ </tex-math></inline-formula> space) and the 3-D configuration space (<inline-formula> <tex-math notation="LaTeX">$\mathcal {C}$ </tex-math></inline-formula> space) of the given agent formation. When performing caging test on a planar object, the algorithm looks up the space mapping to recover the <inline-formula> <tex-math notation="LaTeX">$\mathcal {C}$ </tex-math></inline-formula> space of the given agent formation, labels the recovered <inline-formula> <tex-math notation="LaTeX">$\mathcal {C}$ </tex-math></inline-formula> space, and counts the number of labeled surfaces to judge the success of caging. The algorithm is able to work with various planar shapes, including objects with convex boundaries, concave boundaries, or holes. It can also respond quickly to varying agent formations and different object shapes. Experiments and analysis on different objects and fingertip formations demonstrate the completeness, robustness, and efficiency of our proposal.</p><p><italic>Note to Practitioners</italic>—This paper proposes an algorithm to solve a geometric problem—find whether a given formation of planar points can constrain (or cage) a planar shape. Users can use the proposed algorithm to actuate a formation of robotic fingertips to perform caging-based grasping tasks or use the proposed algorithm to actuate a formation of mobile robots to perform cooperative transportation tasks. The algorithm inherits the merits of caging and helps users to avoid explicit force analysis. It offers robustness to avoid uncertainty in the tasks. The code of our work is in the supplementary material.

[1]  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.

[2]  Yasuo Kuniyoshi,et al.  On the caging region of a third finger with object boundary clouds and two given contact positions , 2012, 2012 IEEE International Conference on Robotics and Automation.

[3]  Seth Hutchinson,et al.  A Framework for Real-time Path Planning in Changing Environments , 2002, Int. J. Robotics Res..

[4]  YangQuan Chen,et al.  Formation control: a review and a new consideration , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  J. F. Soechting,et al.  Postural Hand Synergies for Tool Use , 1998, The Journal of Neuroscience.

[6]  Daniela Rus Coordinated Manipulation of Objects in a Plane , 1997, Algorithmica.

[7]  Yasuo Kuniyoshi,et al.  Grasping by caging: A promising tool to deal with uncertainty , 2012, 2012 IEEE International Conference on Robotics and Automation.

[8]  Weiwei Wan,et al.  Cooperative manipulation with least number of robots via robust caging , 2012, 2012 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM).

[9]  Hongbin Zha,et al.  A dynamic subgoal path planner for unpredictable environments , 2010, 2010 IEEE International Conference on Robotics and Automation.

[10]  Danica Kragic,et al.  Caging complex objects with geodesic balls , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

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

[13]  Siddhartha S. Srinivasa,et al.  Constrained Manipulation Planning , 2011 .

[14]  Matei T. Ciocarlie,et al.  Hand Posture Subspaces for Dexterous Robotic Grasping , 2009, Int. J. Robotics Res..

[15]  Vijay Kumar,et al.  Decentralized Algorithms for Multi-Robot Manipulation via Caging , 2004, Int. J. Robotics Res..

[16]  Joel W. Burdick,et al.  Robust three-finger three-parameter caging of convex polygons , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[17]  Y. Maeda,et al.  Motion planning for 3D multifingered caging with object recognition using AR picture markers , 2012, 2012 IEEE International Conference on Mechatronics and Automation.

[18]  Lynne E. Parker,et al.  ALLIANCE: an architecture for fault tolerant multirobot cooperation , 1998, IEEE Trans. Robotics Autom..

[19]  A. Frank van der Stappen,et al.  Immobilization: Analysis, Existence, and Output- Sensitive Synthesis , 2003, Geometric and Algorithmic Aspects of Computer-Aided Design and Manufacturing.

[20]  Danica Kragic,et al.  Caging Grasps of Rigid and Partially Deformable 3-D Objects With Double Fork and Neck Features , 2016, IEEE Transactions on Robotics.

[21]  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.

[22]  Kazuhiro Kosuge,et al.  An algorithm for testing object caging condition by multiple mobile robots , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[23]  Danica Kragic,et al.  Learning and Evaluation of the Approach Vector for Automatic Grasp Generation and Planning , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[24]  Danica Kragic,et al.  Towards Postural Synergies for Caging Grasps , 2013, ICRA 2013.

[25]  M. Ani Hsieh,et al.  Multi-robot manipulation via caging in environments with obstacles , 2008, 2008 IEEE International Conference on Robotics and Automation.

[26]  David J. Cappelleri,et al.  Caging for 2D and 3D micromanipulation , 2012 .

[27]  Steven M. LaValle,et al.  Rapidly-Exploring Random Trees: Progress and Prospects , 2000 .

[28]  Attawith Sudsang,et al.  Two-Finger Caging of Nonconvex Polytopes , 2011, IEEE Transactions on Robotics.

[29]  R. K. Shyamasundar,et al.  Introduction to algorithms , 1996 .

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

[31]  Maja J. Mataric,et al.  Pusher-watcher: an approach to fault-tolerant tightly-coupled robot coordination , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[32]  Vijay Kumar,et al.  Abstractions and Algorithms for Cooperative Multiple Robot Planar Manipulation , 2008, Robotics: Science and Systems.

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

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

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

[36]  Ronald L. Rivest,et al.  Introduction to Algorithms , 1990 .

[37]  Vijay Kumar,et al.  Cooperative localization and control for multi-robot manipulation , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[38]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[39]  Danica Kragic,et al.  A topology-based object representation for clasping, latching and hooking , 2013, 2013 13th IEEE-RAS International Conference on Humanoid Robots (Humanoids).

[40]  Fred Rothganger,et al.  Capturing a convex object with three discs , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[41]  Wen-Liang Hwang,et al.  Subband Weighting With Pixel Connectivity for 3-D Wavelet Coding , 2009, IEEE Transactions on Image Processing.

[42]  Fred Rothganger,et al.  Motion planning for disc-shaped robots pushing a polygonal object in the plane , 2002, IEEE Trans. Robotics Autom..

[43]  Maja J. Mataric,et al.  Motion planning using dynamic roadmaps , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[44]  Attawith Sudsang,et al.  Coverage Diameters of Polygons , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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