Massively-Parallel Proximity Queries for Point Clouds

We present a novel massively-parallel algorithm that allows real-time distance computations between arbitrary 3D objects and unstructured point cloud data. Our main application scenario is collision avoidance for robots in highly dynamic environments that are recorded via a Kinect, but our algorithm can be easily generalized for other applications such as virtual reality. Basically, we represent the 3D object by a bounding volume hierarchy, therefore we adopted the Inner Sphere Trees data structure, and we process all points of the point cloud in parallel using GPU optimized traversal algorithms. Additionally, all parallel threads share a common upper bound in the minimum distance, this leads to a very high culling efficiency. We implemented our algorithm using CUDA and the results show a real-time performance for online captured point clouds. Our algorithm outperforms previous CPU-based approaches by more than an order of magnitude.

[1]  Gabriel Zachmann,et al.  Inner sphere trees for proximity and penetration queries , 2009, Robotics: Science and Systems.

[2]  Manuela M. Veloso,et al.  Depth camera based indoor mobile robot localization and navigation , 2012, 2012 IEEE International Conference on Robotics and Automation.

[3]  Reinhard Koch,et al.  Pose estimation and map building with a Time-Of-Flight-camera for robot navigation , 2008, Int. J. Intell. Syst. Technol. Appl..

[4]  Mauro Figueiredo,et al.  Interactive Collision Detection for 3D Environments , 2021 .

[5]  Roland Siegwart,et al.  A state-of-the-art 3D sensor for robot navigation , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[6]  Antonio Bicchi,et al.  Integration of active and passive compliance control for safe human-robot coexistence , 2009, 2009 IEEE International Conference on Robotics and Automation.

[7]  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.

[8]  Gabriel Zachmann,et al.  Point Cloud Collision Detection , 2004, Comput. Graph. Forum.

[9]  Paolo Rocco,et al.  Anti-collision systems for robotic applications based on laser Time-of-Flight sensors , 2010, 2010 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[10]  M. Figueiredo,et al.  AN EFFICIENT COLLISION DETECTION ALGORITHM FOR POINT CLOUD MODELS , 2010 .

[11]  Dieter W. Fellner,et al.  Hierarchical spherical distance fields for collision detection , 2006, IEEE Computer Graphics and Applications.

[12]  René Weller,et al.  New geometric data structures for collision detection , 2012 .

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

[14]  Roland Siegwart,et al.  A state-of-the-art 3D sensor for robot navigation , 2004 .

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

[16]  Jing-Sin Liu,et al.  Collision Detection of Deformable Polyhedral Objects via Inner-outer Ellipsoids , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[17]  René Weller,et al.  New Geometric Data Structures for Collision Detection and Haptics , 2013, Springer Series on Touch and Haptic Systems.

[18]  Ian D. Reid,et al.  Mapping Large Loops with a Single Hand-Held Camera , 2007, Robotics: Science and Systems.

[19]  Gabriel Zachmann,et al.  CDFC: Collision Detection Based on Fuzzy Clustering for Deformable Objects on GPU’s , 2013 .

[20]  R. Kelley,et al.  A representation scheme for rapid 3D collision detection , 1988, Proceedings IEEE International Symposium on Intelligent Control 1988.

[21]  Marios Hadjieleftheriou,et al.  R-Trees - A Dynamic Index Structure for Spatial Searching , 2008, ACM SIGSPATIAL International Workshop on Advances in Geographic Information Systems.

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

[23]  Kurt Konolige,et al.  FrameSLAM: From Bundle Adjustment to Real-Time Visual Mapping , 2008, IEEE Transactions on Robotics.

[24]  Dominik Henrich,et al.  Fast vision-based minimum distance determination between known and unkown objects , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[25]  Abdulmotaleb El Saddik,et al.  Collision Detection and Force Response in Highly-Detailed Point-Based Hapto-Visual Virtual Environments , 2007, 11th IEEE International Symposium on Distributed Simulation and Real-Time Applications (DS-RT'07).

[26]  Wei Zhao,et al.  Parallel collision detection algorithm based on mixed BVH and OpenMP , 2008, 2008 Asia Simulation Conference - 7th International Conference on System Simulation and Scientific Computing.

[27]  Oussama Khatib,et al.  A depth space approach to human-robot collision avoidance , 2012, 2012 IEEE International Conference on Robotics and Automation.

[28]  H. D. Taghirad,et al.  Vision-based fuzzy navigation of mobile robots in grassland environments , 2009, 2009 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[29]  Arnulph Fuhrmann,et al.  Distance Fields for Rapid Collision Detection in Physically Based Modeling , 2003 .

[30]  Dinesh Manocha,et al.  gProximity: Hierarchical GPU‐based Operations for Collision and Distance Queries , 2010, Comput. Graph. Forum.

[31]  Patrick Benavidez,et al.  Mobile robot navigation and target tracking system , 2011, 2011 6th International Conference on System of Systems Engineering.

[32]  Gabriel Zachmann,et al.  Parallel Collision Detection in Constant Time , 2013, VRIPHYS.

[33]  Gordon Wyeth,et al.  Obstacle detection using optical flow , 2005 .

[34]  Jérémie Allard,et al.  Image-based collision detection and response between arbitrary volume objects , 2008, SCA '08.

[35]  Gabriel Zachmann,et al.  Interpolation Search for Point Cloud Intersection , 2005, WSCG.

[36]  Huosheng Hu,et al.  CSM-422 Sensors and Data Fusion Algorithms in Mobile Robotics , 2005 .

[37]  Elaine Cohen,et al.  A framework for efficient minimum distance computations , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

[38]  Jing-Sin Liu,et al.  Fast and accurate collision detection based on enclosed ellipsoid , 2001, Robotica.

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

[41]  A. Guttmma,et al.  R-trees: a dynamic index structure for spatial searching , 1984 .

[42]  Wei Zhao,et al.  Improved K-DOPs collision detection algorithms based on genetic algorithms , 2011, Proceedings of 2011 International Conference on Electronic & Mechanical Engineering and Information Technology.

[43]  Antoine Bagula,et al.  Collision Avoidance in Unstructured Environments for Autonomous Robots: A Behavioural Modelling Approach , 2011 .