Effective sampling and distance metrics for 3D rigid body path planning

Important implementation issues in rigid body path planning are often overlooked. In particular, sampling-based motion planning algorithms typically require a distance metric defined on the configuration space, a sampling function, and a method for interpolating sampled points. The configuration space of a 3D rigid body is identified with the Lie group SE(3). Defining proper metrics, sampling, and interpolation techniques for SE(3) is not obvious, and can become a hidden source of failure for many planning algorithm implementations. This paper examines some of these issues and presents techniques which have been found to be effective experimentally for Rigid Body path planning.

[1]  Josip Loncaric,et al.  Geometrical analysis of compliant mechanisms in robotics , 1985 .

[2]  Ken Shoemake,et al.  Animating rotation with quaternion curves , 1985, SIGGRAPH.

[3]  Francis L. Merat,et al.  Introduction to robotics: Mechanics and control , 1987, IEEE J. Robotics Autom..

[4]  J. Michael McCarthy,et al.  Introduction to theoretical kinematics , 1990 .

[5]  James Arvo,et al.  Fast Random Rotation matrices , 1992, Graphics Gems III.

[6]  Ken Shoemake,et al.  Uniform Random Rotations , 1992, Graphics Gems III.

[7]  S. Sastry,et al.  Nonholonomic motion planning: steering using sinusoids , 1993, IEEE Trans. Autom. Control..

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

[9]  Rajeev Motwani,et al.  Path planning in expansive configuration spaces , 1997, Proceedings of International Conference on Robotics and Automation.

[10]  Frank Chongwoo Park,et al.  Smooth invariant interpolation of rotations , 1997, TOGS.

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

[12]  Mark H. Overmars,et al.  The Gaussian sampling strategy for probabilistic roadmap planners , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[13]  Vijay Kumar,et al.  Metrics and Connections for Rigid-Body Kinematics , 1999, Int. J. Robotics Res..

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

[15]  Nancy M. Amato,et al.  Choosing good distance metrics and local planners for probabilistic roadmap methods , 2000, IEEE Trans. Robotics Autom..

[16]  Joel W. Burdick,et al.  Objective and Frame-Invariant Kinematic Metric Functions for Rigid Bodies , 2000, Int. J. Robotics Res..

[17]  Jean-Claude Latombe,et al.  A Single-Query Bi-Directional Probabilistic Roadmap Planner with Lazy Collision Checking , 2001, ISRR.

[18]  Kevin M. Lynch,et al.  Rolling Manipulation with a Single Control , 2002, Int. J. Robotics Res..

[19]  Steven M. LaValle,et al.  On the Relationship between Classical Grid Search and Probabilistic Roadmaps , 2004, Int. J. Robotics Res..

[20]  Dinesh Manocha,et al.  Fast swept volume approximation of complex polyhedral models , 2003, SM '03.