Collision avoidance method for hand-arm robot using both structural model and 3D point cloud

In recent years, obstacle detection has been achieved using laser rangefinders or the Kinect sensor. The point cloud contains the point data of a known object such as a hand-arm robot. In this paper, to remove the known object from the point cloud, we propose a removal method that compares the depth buffer between virtual space and real space. Then a nearest neighbor search with a kd-tree is performed. Also, the closest point pair is calculated with the GJK algorithm between the components of the hand-arm robot using the structural model of the known object. Using both distances, we also propose a controller based on a control performance index containing collision avoidance information. The collision avoidance method is implemented into the slave hand-arm robot for the teleoperated system. Finally, the effectiveness of the proposed method is demonstrated experimentally.

[1]  Haruhisa Kawasaki,et al.  Virtual teaching based on hand manipulability for multi-fingered robots , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[2]  Olivier Stasse,et al.  Real-time (self)-collision avoidance task on a hrp-2 humanoid robot , 2008, 2008 IEEE International Conference on Robotics and Automation.

[3]  Haruhisa Kawasaki,et al.  Experimental investigation of a collision avoidance controller for a bimanual multi-fingered haptic interface , 2013, J. Frankl. Inst..

[4]  T. Yoshikawa,et al.  Task-Priority Based Redundancy Control of Robot Manipulators , 1987 .

[5]  Masafumi Hamaguchi,et al.  Cooperative Transporting Control for Two Redundant Manipulators and One Human (A Method of Obstacle Avoidance Utilizing Kinematic Redundancy) , 2013 .

[6]  Haruhisa Kawasaki,et al.  Design and Control of Five-Fingered Haptic Interface Opposite to Human Hand , 2007, IEEE Transactions on Robotics.

[7]  Dieter Fox,et al.  Manipulator and object tracking for in-hand 3D object modeling , 2011, Int. J. Robotics Res..

[8]  Eiichi Yoshida,et al.  A Local Collision Avoidance Method for Non-strictly Convex Objects , 2009 .

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

[10]  Kazuhiro Kosuge,et al.  Self-collision avoidance motion control for human robot cooperation system using RoBE , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[12]  Alexander Dietrich,et al.  Extensions to reactive self-collision avoidance for torque and position controlled humanoids , 2011, 2011 IEEE International Conference on Robotics and Automation.

[13]  Masayuki Hara,et al.  Integration of impedance control and manipulability regulation for a finger-arm robot , 2009, 2009 IEEE International Conference on Robotics and Automation.

[14]  Michito Matsumoto,et al.  Vision-based Redundancy Control and Image Feature Estimation of Robot Manipulators for Obstacle Avoidance , 1999 .