Redundant Robotic Manipulator Path Planning for Real-Time Obstacle and Self-Collision Avoidance

This paper presents a method to generate joint trajectories for a redundant manipulator. The control system of the manipulator determines the joint references so that the goal pose can be reached without any collisions, in real-time. The control system checks weather any part of the manipulator is at risk of colliding with itself or with any obstacles. If there is a risk of collision, then the collision server computes the exact points where the collision is about to happen and calculates the shortest distance between the colliding objects. The joint trajectories of the manipulator are modified so that collisions will be avoided while at the same time, the trajectory of the end-effector maintains its initial trajectory if possible. Experimental results are given for a 7 DOF redundant manipulator to demonstrate the capability of the collision avoidance control system.

[1]  Geir Hovland,et al.  Collision avoidance with potential fields based on parallel processing of 3D-point cloud data on the GPU , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[2]  T. Greville.  The Pseudoinverse of a Rectangular or Singular Matrix and Its Application to the Solution of Systems of Linear Equations , 1959 .

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

[4]  A. A. Maciejewski,et al.  Obstacle Avoidance , 2005 .

[5]  Oussama Khatib,et al.  Adaptive collision checking for continuous robot motions within motion constraints , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Jun-Ho Oh,et al.  Collision detection system for the practical use of the humanoid robot , 2015, 2015 IEEE-RAS 15th International Conference on Humanoid Robots (Humanoids).

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

[8]  Tamim Asfour,et al.  Toward humanoid manipulation in human-centred environments , 2008, Robotics Auton. Syst..

[9]  Bruno Siciliano,et al.  Modelling and Control of Robot Manipulators , 1997, Advanced Textbooks in Control and Signal Processing.

[10]  Ramakrishnan Mukundan,et al.  Crowd simulation: extended oriented bounding boxes for geometry and motion representation , 2012, IVCNZ '12.

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

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

[13]  Dan Puiu,et al.  Real-time collision avoidance for redundant manipulators , 2011, 2011 6th IEEE International Symposium on Applied Computational Intelligence and Informatics (SACI).

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

[15]  Danijela Ristic-Durrant,et al.  ROVIS: Robust machine vision for service robotic system FRIEND , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[17]  Oussama Khatib,et al.  Real-Time Obstacle Avoidance for Manipulators and Mobile Robots , 1986 .