Path planning in 1000+ dimensions using a task-space Voronoi bias

The reduction of the kinematics and/or dynamics of a high-DOF robotic manipulator to a low-dimension “task space” has proven to be an invaluable tool for designing feedback controllers. When obstacles or other kinodynamic constraints complicate the feedback design process, motion planning techniques can often still find feasible paths, but these techniques are typically implemented in the high-dimensional configuration (or state) space. Here we argue that providing a Voronoi bias in the task space can dramatically improve the performance of randomized motion planners, while still avoiding non-trivial constraints in the configuration (or state) space. We demonstrate the potential of task-space search by planning collision-free trajectories for a 1500 link arm through obstacles to reach a desired end-effector position.

[1]  G. G. Stokes.  "J." , 1890, The New Yale Book of Quotations.

[2]  A. Liegeois,et al.  Automatic supervisory control of the configuration and behavior of multi-body mechanisms , 1977 .

[3]  Russell H. Taylor,et al.  Automatic Synthesis of Fine-Motion Strategies for Robots , 1984 .

[4]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[5]  S. LaValle.  Rapidly-exploring random trees : a new tool for path planning , 1998 .

[6]  Steven M. LaValle,et al.  Randomized Kinodynamic Planning , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

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

[8]  Masayuki Inaba,et al.  Motion planning for humanoid robots under obstacle and dynamic balance constraints , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[9]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[10]  Kazuhito Yokoi,et al.  Biped walking pattern generation by using preview control of zero-moment point , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

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

[12]  Oussama Khatib,et al.  Control of Free-Floating Humanoid Robots Through Task Prioritization , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[13]  Jun Nakanishi,et al.  Comparative experiments on task space control with redundancy resolution , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[14]  Shawna L. Thomas,et al.  Efficient Planning of Spatially Constrained Robot Using Reachable Distances , 2006 .

[15]  Steven M. LaValle,et al.  Planning algorithms , 2006 .

[16]  Tamim Asfour,et al.  An integrated approach to inverse kinematics and path planning for redundant manipulators , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[17]  Siddhartha S. Srinivasa,et al.  Randomized path planning for redundant manipulators without inverse kinematics , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[18]  Russ Tedrake,et al.  Inverse Kinematics for a Point-Foot Quadruped Robot with Dynamic Redundancy Resolution , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[19]  Mike Stilman,et al.  Task constrained motion planning in robot joint space , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  Russ Tedrake,et al.  High-dimensional underactuated motion planning via task space control , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[21]  Oliver Brock,et al.  BiSpace Planning: Concurrent Multi-Space Exploration , 2009 .