Dynamic obstacle avoidance for manipulators using distance calculation and discrete detection

Abstract In order to avoid dynamic obstacle timely during manufacturing tasks performed by manipulators, a novel method based on distance calculation and discrete detection is proposed. The nearest distances between the links of a manipulator and the convex hull of an arbitrarily-shaped dynamic obstacle obtained from Kinect-V2 camera in real-time are calculated by Gilbert–Johnson–Keerthi algorithm, and the minimum one is defined as the closest distance between the manipulator and the obstacle. When the closest distance is less than a safe value, whether the dynamic obstacle is located in the global path of the manipulator is determined by improved discrete collision detection, which can adjust detection step-size adaptively for accuracy and efficiency. If the obstacle will collide with the manipulator, set a local goal and re-plan a local path for the manipulator. The proposed method is implemented in Robot Operating System (ROS) using C++. The experiments indicate that the proposed method can perform safe and timely dynamic avoidance for redundant manipulators in human-robot interaction.

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

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

[3]  Ming C. Lin,et al.  Accurate and Fast Proximity Queries Between Polyhedra Using Convex Surface Decomposition , 2001, Comput. Graph. Forum.

[4]  Xinyu Zhang,et al.  A Simple Filtering Algorithm for Continuous Collision Detection Using Taylor Models , 2015, 2015 14th International Conference on Computer-Aided Design and Computer Graphics (CAD/Graphics).

[5]  Gheorghe Leonte Mogan,et al.  Obstacle avoidance of redundant manipulators using neural networks based reinforcement learning , 2012 .

[6]  Wolfram Burgard,et al.  OctoMap: an efficient probabilistic 3D mapping framework based on octrees , 2013, Autonomous Robots.

[7]  David P. Dobkin,et al.  The quickhull algorithm for convex hulls , 1996, TOMS.

[8]  Patrick G. Xavier,et al.  Fast swept-volume distance for robust collision detection , 1997, Proceedings of International Conference on Robotics and Automation.

[9]  Dinesh Manocha,et al.  Hierarchical and Controlled Advancement for Continuous Collision Detectionof Rigid and Articulated Models , 2014, IEEE Transactions on Visualization and Computer Graphics.

[10]  Junjie Shen,et al.  MULTIMAP AND MULTISET DATA STRUCTURES IN STAPL , 2014 .

[11]  Elmer G. Gilbert,et al.  Fast versions of the Gilbert-Johnson-Keerthi distance algorithm: additional results and comparisons , 2001, IEEE Trans. Robotics Autom..

[12]  Sang-Young Oh,et al.  A GJK Based Real-Time Collision Detection Algorithm for Moving Objects , 2008 .

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

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

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

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

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

[18]  Mingcong Deng,et al.  Two-wheeled mobile robot motion control in dynamic environments , 2010 .

[19]  Dinesh Manocha,et al.  FCL: A general purpose library for collision and proximity queries , 2012, 2012 IEEE International Conference on Robotics and Automation.

[20]  Wei Zhao,et al.  A Fast Collision Detection Algorithm Based on Distance Calculations between NURBS Surfaces , 2012, 2012 International Conference on Computer Science and Electronics Engineering.

[21]  Stephen Cameron,et al.  Enhancing GJK: computing minimum and penetration distances between convex polyhedra , 1997, Proceedings of International Conference on Robotics and Automation.

[22]  Z. Li,et al.  Teleoperation control of Baxter robot using body motion tracking , 2014, 2014 International Conference on Multisensor Fusion and Information Integration for Intelligent Systems (MFI).

[23]  Shiqiu Liu,et al.  GKJ and clustering based algorithm for collision detection on deformable body , 2011, 2011 International Conference on Multimedia Technology.

[24]  S. G. Ponnambalam,et al.  Obstacle avoidance control of redundant robots using variants of particle swarm optimization , 2012 .

[25]  Ren C. Luo,et al.  Repulsive reaction vector generator for whole-arm collision avoidance of 7-DoF redundant robot manipulator , 2014, 2014 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[26]  Ren C. Luo,et al.  Intelligent Seven-DoF Robot With Dynamic Obstacle Avoidance and 3-D Object Recognition for Industrial Cyber–Physical Systems in Manufacturing Automation , 2016, Proceedings of the IEEE.

[27]  Abdullah Bade,et al.  Balanced hierarchical construction in collision detection for rigid bodies , 2010, 2010 International Conference on Science and Social Research (CSSR 2010).

[28]  Christian Laugier,et al.  Dynamic Obstacle Avoidance in uncertain environment combining PVOs and Occupancy Grid , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[29]  Ji Xiang,et al.  Moving obstacle avoidance for redundant manipulator via weighted least norm method , 2015, The 27th Chinese Control and Decision Conference (2015 CCDC).

[30]  Ping Jun Xia,et al.  Dynamic Collision Detection with Optimum Discrete Interval , 2010 .

[31]  Wolfram Luther,et al.  The GJK Distance Algorithm: An Interval Version for Incremental Motions , 2004, Numerical Algorithms.

[32]  Ren C. Luo,et al.  Dynamic multi-obstacles avoidance of a robot manipulator based on repulsive vector summation for human-robot co-works , 2015, 2015 IEEE International Conference on Advanced Intelligent Mechatronics (AIM).