Efficient probabilistic collision detection for non-convex shapes

We present new algorithms to perform fast probabilistic collision queries between convex as well as non-convex objects. Our approach is applicable to general shapes, where one or more objects are represented using Gaussian probability distributions. We present a fast new algorithm for a pair of convex objects, and extend the approach to non-convex models using hierarchical representations. We highlight the performance of our algorithms with various convex and non-convex shapes on complex synthetic benchmarks and trajectory planning benchmarks for a 7-DOF Fetch robot arm.

[1]  Dinesh Manocha,et al.  Quick-CULLIDE: fast inter- and intra-object collision culling using graphics hardware , 2005, IEEE Proceedings. VR 2005. Virtual Reality, 2005..

[2]  Jur P. van den Berg,et al.  Efficient exact collision-checking of 3-D rigid body motions using linear transformations and distance computations in workspace , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[3]  Chonhyon Park,et al.  ITOMP: Incremental Trajectory Optimization for Real-Time Replanning in Dynamic Environments , 2012, ICAPS.

[4]  Leonidas J. Guibas,et al.  Bounded Uncertainty Roadmaps for Path Planning , 2008, WAFR.

[5]  Dinesh Manocha,et al.  LQG-obstacles: Feedback control with collision avoidance for mobile robots with motion and sensing uncertainty , 2012, 2012 IEEE International Conference on Robotics and Automation.

[6]  Gabriel Zachmann,et al.  Collision Detection for Deformable Objects , 2004, Comput. Graph. Forum.

[7]  M. Levas.  OBBTree : A Hierarchical Structure for Rapid Interference Detection , .

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

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

[10]  Derek D. Lichti,et al.  A Closed-Form Expression of the Positional Uncertainty for 3D Point Clouds , 2009, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[11]  Pieter Abbeel,et al.  Sigma hulls for Gaussian belief space planning for imprecise articulated robots amid obstacles , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Joseph S. B. Mitchell,et al.  Efficient Collision Detection Using Bounding Volume Hierarchies of k-DOPs , 1998, IEEE Trans. Vis. Comput. Graph..

[13]  S. Sathiya Keerthi,et al.  A fast procedure for computing the distance between complex objects in three-dimensional space , 1988, IEEE J. Robotics Autom..

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

[15]  Dinesh Manocha,et al.  Real-time collision detection and distance computation on point cloud sensor data , 2013, 2013 IEEE International Conference on Robotics and Automation.

[16]  Michael Beetz,et al.  Real-time perception-guided motion planning for a personal robot , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[17]  Nicholas Roy,et al.  Rapidly-exploring Random Belief Trees for motion planning under uncertainty , 2011, 2011 IEEE International Conference on Robotics and Automation.

[18]  Philip M. Hubbard,et al.  Interactive collision detection , 1993, Proceedings of 1993 IEEE Research Properties in Virtual Reality Symposium.

[19]  Dominique Gruyer,et al.  A fast Monte Carlo algorithm for collision probability estimation , 2008, 2008 10th International Conference on Control, Automation, Robotics and Vision.

[20]  William K. Durfee,et al.  IEEE/RSJ/GI International Conference on Intelligent Robots and Systems , 1994 .

[21]  Dinesh Manocha,et al.  Probabilistic Collision Detection Between Noisy Point Clouds Using Robust Classification , 2011, ISRR.

[22]  Andrea Sanna,et al.  CDFast: an Algorithm Combining Different Bounding Volume Strategies for Real Time Collision Detection , 2004 .

[23]  Dinesh Manocha,et al.  Collision and Proximity Queries , 2004, Handbook of Discrete and Computational Geometry, 2nd Ed..

[24]  Chonhyon Park,et al.  I-Planner: Intention-aware motion planning using learning-based human motion prediction , 2016, Robotics: Science and Systems.

[25]  Joel W. Burdick,et al.  Probabilistic Collision Checking With Chance Constraints , 2011, IEEE Transactions on Robotics.

[26]  Christer Ericson,et al.  Real-Time Collision Detection , 2004 .

[27]  Chonhyon Park,et al.  Fast and Bounded Probabilistic Collision Detection in Dynamic Environments for High-DOF Trajectory Planning , 2016, ArXiv.

[28]  L. Blackmore.  A Probabilistic Particle Control Approach to Optimal, Robust Predictive Control , 2006 .

[29]  D. Manocha,et al.  Fast proximity computation among deformable models using discrete Voronoi diagrams , 2006, ACM Trans. Graph..