Sampling-based motion planning with reachable volumes: Theoretical foundations

We introduce a new concept, reachable volumes, that denotes the set of points that the end effector of a chain or linkage can reach. We show that the reachable volume of a chain is equivalent to the Minkowski sum of the reachable volumes of its links, and give an efficient method for computing reachable volumes. We present a method for generating configurations using reachable volumes that is applicable to various types of robots including open and closed chain robots, tree-like robots, and complex robots including both loops and branches. We also describe how to apply constraints (both on end effectors and internal joints) using reachable volumes. Unlike previous methods, reachable volumes work for spherical and prismatic joints as well as planar joints. Visualizations of reachable volumes can allow an operator to see what positions the robot can reach and can guide robot design. We present visualizations of reachable volumes for representative robots including closed chains and graspers as well as for examples with joint and end effector constraints.

[1]  K. Ball.  CONVEX BODIES: THE BRUNN–MINKOWSKI THEORY , 1994 .

[2]  Troy McMahon,et al.  Sampling Based Motion Planning with Reachable Volumes , 2016 .

[3]  Li Han,et al.  Bending and kissing: Computing self-contact configurations of planar loops with revolute joints , 2009, 2009 IEEE International Conference on Robotics and Automation.

[4]  Li Han,et al.  Configurations and Path Planning of Convex Planar Polygonal Loops , 2012, WAFR.

[5]  J. Trinkle,et al.  THE GEOMETRY OF CONFIGURATION SPACES FOR CLOSED CHAINS IN TWO AND THREE DIMENSIONS , 2004 .

[6]  Lydia E. Kavraki,et al.  A probabilistic roadmap approach for systems with closed kinematic chains , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[7]  D. Thalmann,et al.  Planning collision-free reaching motions for interactive object manipulation and grasping , 2008, SIGGRAPH '08.

[8]  Nancy M. Amato,et al.  A kinematics-based probabilistic roadmap method for high DOF closed chain systems , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[9]  Jeffrey C. Trinkle,et al.  Complete Path Planning for Closed Kinematic Chains with Spherical Joints , 2002, Int. J. Robotics Res..

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

[11]  Nancy M. Amato,et al.  A Kinematics-Based Probabilistic Roadmap Method for Closed Chain Systems , 2001 .

[12]  Giuseppe Oriolo,et al.  Motion Planning for Mobile Manipulators along Given End-effector Paths , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[13]  Daniel Thalmann,et al.  Planning Collision‐Free Reaching Motions for Interactive Object Manipulation and Grasping , 2003, Comput. Graph. Forum.

[14]  Li Han,et al.  A Unified Geometric Approach for Inverse Kinematics of a Spatial Chain with Spherical Joints , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[15]  Thierry Siméon,et al.  Dynamic-Domain RRTs: Efficient Exploration by Controlling the Sampling Domain , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[16]  Ming C. Lin,et al.  Constraint-Based Motion Planning Using Voronoi Diagrams , 2002, WAFR.

[17]  John J. Craig Zhu,et al.  Introduction to robotics mechanics and control , 1991 .

[18]  Siddhartha S. Srinivasa,et al.  CHOMP: Covariant Hamiltonian optimization for motion planning , 2013, Int. J. Robotics Res..

[19]  Nancy M. Amato,et al.  Reachable Distance Space: Efficient Sampling-Based Planning for Spatially Constrained Systems , 2010, Int. J. Robotics Res..

[20]  Kamal K. Gupta,et al.  Path planning with general end-effector constraints: using task space to guide configuration space search , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[21]  Li Han,et al.  Convexly Stratified Deformation Spaces and Efficient Path Planning for Planar Closed Chains with Revolute Joints , 2008, Int. J. Robotics Res..

[22]  Li Han,et al.  Inverse Kinematics for a Serial Chain with Joints Under Distance Constraints , 2006, Robotics: Science and Systems.

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

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

[25]  Li Han.  Hybrid probabilistic RoadMap - Monte Carlo motion planning for closed chain systems with spherical joints , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[26]  Chih-Cheng Chen,et al.  A combined optimization method for solving the inverse kinematics problems of mechanical manipulators , 1991, IEEE Trans. Robotics Autom..

[27]  Kris K. Hauser,et al.  Unbiased, scalable sampling of closed kinematic chains , 2013, 2013 IEEE International Conference on Robotics and Automation.

[28]  Reid G. Simmons,et al.  Voxel-based motion bounding and workspace estimation for robotic manipulators , 2012, 2012 IEEE International Conference on Robotics and Automation.

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

[30]  Léonard Jaillet,et al.  Path Planning with Loop Closure Constraints Using an Atlas-Based RRT , 2011, ISRR.

[31]  Li Han,et al.  Simplex-Tree Based Kinematics of Foldable Objects as Multi-body Systems Involving Loops , 2008, Robotics: Science and Systems.

[32]  J-P. Merlet,et al.  Still a long way to go on the road for parallel mechanisms , 2009 .

[33]  Steven M. LaValle,et al.  Motion Planning for Highly Constrained Spaces , 2009 .

[34]  Dinesh Manocha,et al.  OBBTree: a hierarchical structure for rapid interference detection , 1996, SIGGRAPH.