Spherical parabolic blends for robot workspace trajectories

We present a new approach to generate workspace trajectories for multiple waypoints. To satisfy workspace constraints with constant-axis rotation, this method splines a given sequence of orientations, maintaining constant-axis within each segment. This improves on other approaches which are point-to-point or take indirect paths. We derive this approach by blending subsequent spherical linear interpolation phases, computing interpolation parameters so that rotational velocity is continuous. We show this method first on simulated manipulator and then perform a physical screwing task on a Schunk LWA4 robot arm. Finally, we provide permissively licensed software which implements this trajectory generation and tracking.

[1]  G. Oriolo,et al.  Robotics: Modelling, Planning and Control , 2008 .

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

[3]  Neil T. Dantam,et al.  Robust and efficient communication for real-time multi-process robot software , 2012, 2012 12th IEEE-RAS International Conference on Humanoid Robots (Humanoids 2012).

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

[5]  Mike Stilman,et al.  Global Manipulation Planning in Robot Joint Space With Task Constraints , 2010, IEEE Transactions on Robotics.

[6]  Sung Yong Shin,et al.  A general construction scheme for unit quaternion curves with simple high order derivatives , 1995, SIGGRAPH.

[7]  Kris K. Hauser,et al.  Fast Interpolation and Time-Optimization on Implicit Contact Submanifolds , 2013, Robotics: Science and Systems.

[8]  Peter I. Corke,et al.  Robotics, Vision and Control - Fundamental Algorithms in MATLAB® , 2011, Springer Tracts in Advanced Robotics.

[9]  W. Chung,et al.  Realization of orientation interpolation of 6-axis articulated robot using quaternion , 2012 .

[10]  N. Roy,et al.  Time-Optimal Trajectory Generation for Path Following with Bounded Acceleration and Velocity , 2013 .

[11]  Torsten Kröger,et al.  On-Line Trajectory Generation in Robotic Systems - Basic Concepts for Instantaneous Reactions to Unforeseen (Sensor) Events , 2010, Springer Tracts in Advanced Robotics.

[12]  F. Park,et al.  Cubic spline algorithms for orientation interpolation , 1999 .

[13]  Yoshihiko Nakamura,et al.  Inverse kinematic solutions with singularity robustness for robot manipulator control , 1986 .

[14]  John J. Craig Zhu,et al.  Introduction to robotics mechanics and control , 1991 .

[15]  Erik B. Dam,et al.  Quaternions, Interpolation and Animation , 2000 .

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