Manipulator motion planning with unconstrained end-effector under obstacle environment

This paper proposes a novel way of carrying out manipulator motion planning with unconstrained end-effector (MMP-UE) under an obstacle environment, where an unconstrained end-effector implies that the end-effector can be displaced from the target object. We introduce two kinds of manipulator motion planning methods: the -based MMP-UE method and the -based MMP-UE method. The former finds a solution path for manipulator motion planning in the configuration space iteratively by extending the terminal trees in the constraint-satisfying subspace and a messenger tree in the configuration space and by connecting the terminal trees and the messenger tree to each other. The latter finds a solution path for manipulator motion planning in the task space by incrementally and randomly generating an extended point that can be added to the current master tree, finding the nearest point in the current master tree from the generated extended point, generating a set of reachable configurations that corresponds to the generated extended point, checking whether two consecutive sets of reachable configurations and are connectable, and finally extending the current slave and master tree if the consecutive sets of reachable configurations are connectable. We evaluated the performance of the two proposed methods in terms of the number of iterations, number of samples, number of generated nodes, and the total computation time through three different experiments: a toy train tunnel passing simulation, a wheel turning simulation, and a basket tunnel passing experiment using a real robot. The experimental results indicate that the two proposed methods succeed in finding the solution paths in all the experiments and that the -based MMP-UE method is faster and requires less storage than the -based MMP-UE method. Graphical Abstract

[1]  Chih-Cheng Chen,et al.  A combined optimization method for solving the inverse kinematics problems of mechanical manipulators , 1991, IEEE Trans. Robotics Autom..

[2]  Steven M. LaValle,et al.  Efficient nearest neighbor searching for motion planning , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[3]  Nancy M. Amato,et al.  Reachable Distance Space: Efficient Sampling-Based Planning for Spatially Constrained Systems , 2010, Int. J. Robotics Res..

[4]  Sung Yong Shin,et al.  A hierarchical approach to interactive motion editing for human-like figures , 1999, SIGGRAPH.

[5]  Dinesh Manocha,et al.  Fast Proximity Queries with Swept Sphere Volumes , 1999 .

[6]  JeheeLee SungYongShin A Hierarchical Approach to Interactive Motion Editing for Human-like Figures , 1999 .

[7]  S. Buss Introduction to Inverse Kinematics with Jacobian Transpose , Pseudoinverse and Damped Least Squares methods , 2004 .

[8]  James Gray,et al.  The Blender Book: Free 3d Graphics Software for the Web and Video with Cdrom , 2000 .

[9]  Oussama Khatib,et al.  Synthesis of Whole-Body Behaviors through Hierarchical Control of Behavioral Primitives , 2005, Int. J. Humanoid Robotics.

[10]  Chris Welman,et al.  INVERSE KINEMATICS AND GEOMETRIC CONSTRAINTS FOR ARTICULATED FIGURE MANIPULATION , 1993 .

[11]  Don Burns,et al.  Open Scene Graph A: Introduction, B: Examples and Applications , 2004 .

[12]  R. Paul,et al.  Kinematic control equations for simple manipulators , 1978, 1978 IEEE Conference on Decision and Control including the 17th Symposium on Adaptive Processes.

[13]  Siddhartha S. Srinivasa,et al.  Manipulation planning on constraint manifolds , 2009, 2009 IEEE International Conference on Robotics and Automation.

[14]  Kamal K. Gupta,et al.  Path planning with general end-effector constraints: using task space to guide configuration space search , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  Lydia E. Kavraki,et al.  A probabilistic roadmap approach for systems with closed kinematic chains , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[16]  G. Swaminathan Robot Motion Planning , 2006 .

[17]  Norman I. Badler,et al.  Real-Time Inverse Kinematics Techniques for Anthropomorphic Limbs , 2000, Graph. Model..

[18]  Norman I. Badler,et al.  Inverse kinematics positioning using nonlinear programming for highly articulated figures , 1994, TOGS.