An online method for tight-tolerance insertion tasks for string and rope

This paper presents a fast tight-tolerance threading technique for string and rope. Instead of relying on simulations of these deformable objects to plan a path or compute control actions, we control the movement of the string with a virtual magnetic vector field emanating from the narrow openings we wish to thread through. We compute an approximate Jacobian to move the tip of the string through the vector field and propose a method to promote alignment of the head of the string to the opening. We also propose a method for re-grasping the string based on the relationship between the string's configuration, the orientation of the opening, and direction of gravity. This re-grasping method in conjunction with our controller can be used to thread the string through a sequence of openings. We evaluated our method in simulation (with simulated sensor noise) and on the Da Vinci surgical robot. Our results suggest that our method is quite robust to errors in sensing, and is capable of real-world threading tasks with the da Vinci robot, where the diameter of the string (3.5mm) and opening (4.9mm) differ by only 1.4 mm.

[1]  Russell H. Taylor,et al.  Automatic Synthesis of Fine-Motion Strategies for Robots , 1984 .

[2]  Daniel Cohen-Or,et al.  L1-medial skeleton of point cloud , 2013, ACM Trans. Graph..

[3]  Wolfram Burgard,et al.  Efficient motion planning for manipulation robots in environments with deformable objects , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  Jun Takamatsu,et al.  Knot planning from observation , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[5]  Bruno Siciliano,et al.  Modelling and Control of Robot Manipulators , 1997, Advanced Textbooks in Control and Signal Processing.

[6]  Nancy M. Amato,et al.  An obstacle-based rapidly-exploring random tree , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[7]  Shinichi Hirai,et al.  Indirect simultaneous positioning of deformable objects with multi-pinching fingers based on an uncertain model , 2000, Robotica.

[8]  J.T. Wen,et al.  Robotic assistants aid surgeons during minimally invasive procedures , 2001, IEEE Engineering in Medicine and Biology Magazine.

[9]  Sandra Hirche,et al.  Autonomous manipulation of deformable objects based on teleoperated demonstrations , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Vijay Kumar,et al.  Identification and Representation of Homotopy Classes of Trajectories for Search-based Path Planning in 3D , 2011, Robotics: Science and Systems.

[11]  Masayuki INABA,et al.  Hand Eye Coordination in Rope Handling , 1985 .

[12]  Oussama Khatib,et al.  A unified approach for motion and force control of robot manipulators: The operational space formulation , 1987, IEEE J. Robotics Autom..

[13]  Yunhui Liu,et al.  Visually servoed deformation control by robot manipulators , 2013, 2013 IEEE International Conference on Robotics and Automation.

[14]  Daniel E. Koditschek,et al.  Sequential Composition of Dynamically Dexterous Robot Behaviors , 1999, Int. J. Robotics Res..

[15]  Heinz Wörn,et al.  Robot Manipulation of Deformable Objects: Advanced Manufacturing , 2000 .

[16]  Timothy Bretl,et al.  Quasi-static manipulation of a Kirchhoff elastic rod based on a geometric analysis of equilibrium configurations , 2014, Int. J. Robotics Res..

[17]  Alexandru Patriciu,et al.  Deformation Planning for Robotic Soft Tissue Manipulation , 2009, 2009 Second International Conferences on Advances in Computer-Human Interactions.

[18]  Lydia E. Kavraki,et al.  Path planning for deformable linear objects , 2006, IEEE Transactions on Robotics.

[19]  Dmitry Berenson,et al.  Manipulation of deformable objects without modeling and simulating deformation , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  Pieter Abbeel,et al.  Learning from Demonstrations Through the Use of Non-rigid Registration , 2013, ISRR.

[21]  Russ Tedrake,et al.  LQR-trees: Feedback motion planning on sparse randomized trees , 2009, Robotics: Science and Systems.

[22]  Oussama Khatib,et al.  Synthesis of Whole-Body Behaviors through Hierarchical Control of Behavioral Primitives , 2005, Int. J. Humanoid Robotics.

[23]  Ian R. Manchester,et al.  LQR-trees: Feedback Motion Planning via Sums-of-Squares Verification , 2010, Int. J. Robotics Res..

[24]  Vijay Kumar,et al.  Invariants for homology classes with application to optimal search and planning problem in robotics , 2012, Annals of Mathematics and Artificial Intelligence.

[25]  Bruce Randall Donald.  Planning Multi-Step Error Detection and Recovery Strategies , 1990, Int. J. Robotics Res..

[26]  Ron Alterovitz,et al.  Motion Planning Under Uncertainty In Highly Deformable Environments , 2011, Robotics: Science and Systems.

[27]  Nancy M. Amato,et al.  Planning motion in completely deformable environments , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[28]  Mitul Saha,et al.  Motion planning for robotic manipulation of deformable linear objects , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[29]  Shinichi Hirai,et al.  Robust manipulation of deformable objects by a simple PID feedback , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[30]  Vijay Kumar,et al.  Topological constraints in search-based robot path planning , 2012, Auton. Robots.

[31]  Kazuhito Yokoi,et al.  Regrasp planning for pivoting manipulation by a humanoid robot , 2009, 2009 IEEE International Conference on Robotics and Automation.

[32]  Sami Haddadin,et al.  Reactive Motion Generation for Robots in Dynamic Environments , 2011 .

[33]  Pierre Payeur,et al.  Dexterous Robotic Manipulation of Deformable Objects with Multi-Sensory Feedback - a Review , 2010 .

[34]  Lydia E. Kavraki,et al.  Planning Paths for Elastic Objects under Manipulation Constraints , 2001, Int. J. Robotics Res..

[35]  Ankush Gupta,et al.  A case study of trajectory transfer through non-rigid registration for a simplified suturing scenario , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.