Practical Local Planning in the Contact Space

Proximity query is an integral part of any motion planning algorithm and takes up the majority of planning time. Due to performance issues, most existing planners perform queries at fixed sampled configurations, sometimes resulting in missed collisions. Moreover, randomly determining collision-free configurations makes it difficult to obtain samples close to, or on, the surface of C-obstacles in the configuration space. In this paper, we present an efficient and practical local planning method in contact space which uses “continuous collision detection” (CCD). We show how, using the precise contact information provided by a CCD algorithm, a randomized planner can be enhanced by efficiently sampling the contact space, as well as by constraining the sampling when the roadmap is expanded. We have included our contact-space planning methods in a freely available state-of-the-art planning library - the Stanford MPK library. We have been able to observe that in complex scenarios involving cluttered and narrow passages, which are typically difficult for randomized planners, the enhanced planner offers up to 70 times performance improvement when our contact-space sampling and constrained sampling methods are enabled.

[1]  Jarek Rossignac,et al.  Collision prediction for polyhedra under screw motions , 2003, SM '03.

[2]  Mark H. Overmars,et al.  A random approach to motion planning , 1992 .

[3]  Xuerong Ji,et al.  Automatic Generation of High-Level Contact State Space , 2001, Int. J. Robotics Res..

[4]  Ming C. Lin,et al.  Constraint-based motion planning for virtual prototyping , 2002, SMA '02.

[5]  Micha Sharir,et al.  Retraction: A new approach to motion-planning , 1983, STOC.

[6]  Lydia E. Kavraki,et al.  On finding narrow passages with probabilistic roadmap planners , 1998 .

[7]  Leonidas J. Guibas,et al.  A probabilistic roadmap planner for flexible objects with a workspace medial-axis-based sampling approach , 1999, Proceedings 1999 IEEE/RSJ International Conference on Intelligent Robots and Systems. Human and Environment Friendly Robots with High Intelligence and Emotional Quotients (Cat. No.99CH36289).

[8]  John Canny,et al.  The complexity of robot motion planning , 1988 .

[9]  Keiji Nagatani,et al.  Sensor-based planning: using a honing strategy and local map method to implement the generalized Voronoi graph , 1998, Other Conferences.

[10]  Steven M. LaValle,et al.  RRT-connect: An efficient approach to single-query path planning , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[11]  B. Faverjon,et al.  A local based approach for path planning of manipulators with a high number of degrees of freedom , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[12]  Nancy M. Amato,et al.  Motion planning for a rigid body using random networks on the medial axis of the free space , 1999, SCG '99.

[13]  Abderrahmane Kheddar,et al.  Fast Continuous Collision Detection between Rigid Bodies , 2002, Comput. Graph. Forum.

[14]  Howie Choset.  Nonsmooth Analysis, Convex Analysis, and their Applications to Motion Planning , 1999, Int. J. Comput. Geom. Appl..

[15]  Bruce Randall Donald,et al.  Simplified Voronoi diagrams , 1987, SCG '87.

[16]  J. Laumond,et al.  An iterative diffusion algorithm for part disassembly , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[17]  Abderrahmane Kheddar,et al.  Gauss' least constraints principle and rigid body simulations , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[18]  Nancy M. Amato,et al.  MAPRM: a probabilistic roadmap planner with sampling on the medial axis of the free space , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[19]  Dinesh Manocha,et al.  Fast continuous collision detection for articulated models , 2004, SM '04.

[20]  Mark H. Overmars,et al.  A probabilistic learning approach to motion planning , 1995 .

[21]  Mitul Saha,et al.  Exact Collision Checking of Robot Paths , 2002, WAFR.

[22]  Lydia E. Kavraki,et al.  Randomized preprocessing of configuration for fast path planning , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[23]  Jean-Claude Latombe,et al.  A Single-Query Bi-Directional Probabilistic Roadmap Planner with Lazy Collision Checking , 2001, ISRR.

[24]  Dinesh Manocha,et al.  Randomized Path Planning for a Rigid Body Based on Hardware Accelerated Voronoi Sampling , 1999 .

[25]  D. Wilhelmsen.  A nearest point algorithm for convex polyhedral cones and applications to positive linear approximation , 1976 .

[26]  Tsai-Yen Li,et al.  Assembly maintainability study with motion planning , 1995, Proceedings of 1995 IEEE International Conference on Robotics and Automation.

[27]  Abderrahmane Kheddar,et al.  An algebraic solution to the problem of collision detection for rigid polyhedral objects , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[28]  John F. Canny,et al.  Collision Detection for Moving Polyhedra , 1986, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[29]  Kenneth I. Joy,et al.  Swept Volumes: Fundation, Perspectives, and Applications , 2006, Int. J. Shape Model..

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

[31]  Daniel Vallejo,et al.  OBPRM: an obstacle-based PRM for 3D workspaces , 1998 .

[32]  Jean-Claude Latombe,et al.  Robot motion planning , 1970, The Kluwer international series in engineering and computer science.

[33]  Bettina Speckmann,et al.  Kinetic collision detection for simple polygons , 2000, SCG '00.

[34]  Henning Tolle,et al.  Motion planning with many degrees of freedom-random reflections at C-space obstacles , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[35]  Qi Luo,et al.  On the representation of contact states between curved objects , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.