Exact Collision Checking of Robot Paths

This paper describes a new exact and efficient collision checker for testing single straight-line segments in c-space or sequences of such segments. This checker is particularly suited for probabilistic roadmap (PRM) planners applied to manipulator arms and multi-robot systems. Unlike the commonly used fixed-resolution method, the new checker does not require manual tuning of the resolution parameter and cannot fail to find existing collisions. To achieve this, it automatically and dynamically adjusts the required local c-space resolution by relating distances and path lengths in workspace. Several additional techniques are presented in this paper to further increase the checker’s efficiency in PRM planners and scenarios with high geometric complexity. Extensive experiments, first on segments randomly generated in c-space, next as part of an existing PRM planner, and finally as part of a path smoother/optimizer have shown that the new checker is faster than the common resolution-based approach (with suitable resolution).

[1]  Stephen Cameron,et al.  Collision detection by four-dimensional intersection testing , 1990, IEEE Trans. Robotics Autom..

[2]  Gino van den Bergen Efficient Collision Detection of Complex Deformable Models using AABB Trees , 1997, J. Graphics, GPU, & Game Tools.

[3]  Mark H. Overmars,et al.  Algorithms for Robotic Motion and Manipulation : WAFR 1996 , 1997 .

[4]  A. Leach Molecular Modelling: Principles and Applications , 1996 .

[5]  Rajeev Motwani,et al.  Path Planning in Expansive Configuration Spaces , 1999, Int. J. Comput. Geom. Appl..

[6]  Lydia E. Kavraki,et al.  A Random Sampling Scheme for Path Planning , 1997, Int. J. Robotics Res..

[7]  Nancy M. Amato,et al.  Faster, More Effective Connection for Probabilistic Roadmaps , 2000 .

[8]  Brian Mirtich,et al.  V-Clip: fast and robust polyhedral collision detection , 1998, TOGS.

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

[10]  Ming C. Lin,et al.  Collision Detection between Geometric Models: A Survey , 1998 .

[11]  Ming C. Lin,et al.  A fast algorithm for incremental distance calculation , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[12]  Stephen Cameron,et al.  A study of the clash detection problem in robotics , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

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

[14]  Dinesh Manocha,et al.  Collision Detection: Algorithms and Applications , 1996 .

[15]  T. Siméon,et al.  Motion Planning , 2019, Aerial Robotic Manipulation.

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

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

[18]  Lydia E. Kavraki,et al.  Probabilistic roadmaps for path planning in high-dimensional configuration spaces , 1996, IEEE Trans. Robotics Autom..

[19]  Lydia E. Kavraki,et al.  Path planning using lazy PRM , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[20]  Dinesh Manocha,et al.  Fast distance queries with rectangular swept sphere volumes , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[21]  Lydia E. Kavraki,et al.  A two level fuzzy PRM for manipulation planning , 2000, Proceedings. 2000 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2000) (Cat. No.00CH37113).

[22]  Sean Quinlan,et al.  Efficient distance computation between non-convex objects , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[23]  Carme Torras,et al.  3D collision detection: a survey , 2001, Comput. Graph..

[24]  Achim Schweikard,et al.  Polynomial time collision detection for manipulator paths specified by joint motions , 1991, IEEE Trans. Robotics Autom..

[25]  Dinesh Manocha,et al.  I-COLLIDE: an interactive and exact collision detection system for large-scale environments , 1995, I3D '95.

[26]  Leonidas J. Guibas,et al.  Data structures for mobile data , 1997, SODA '97.