Fast smoothing of manipulator trajectories using optimal bounded-acceleration shortcuts

This paper considers a shortcutting heuristic to smooth jerky trajectories for many-DOF robot manipulators subject to collision constraints, velocity bounds, and acceleration bounds. The heuristic repeatedly picks two points on the trajectory and attempts to replace the intermediate trajectory with a shorter, collision-free segment. Here, we construct segments that interpolate between endpoints with specified velocity in a time-optimal fashion, while respecting velocity and acceleration bounds. These trajectory segments consist of parabolic and straight-line curves, and can be computed in closed form. Experiments on reaching tasks in cluttered human environments demonstrate that the technique can generate smooth, collision-free, and natural-looking motion in seconds for a PUMA manipulator and the Honda ASIMO robot.

[1]  L. M. Sonneborn,et al.  The Bang-Bang Principle for Linear Control Systems , 1964 .

[2]  Steven Dubowsky,et al.  Time optimal trajectory planning for robotic manipulators with obstacle avoidance: A CAD approach , 1986, Proceedings. 1986 IEEE International Conference on Robotics and Automation.

[3]  James E. Bobrow,et al.  Optimal Robot Path Planning Using the Minimum-Time Criterion , 2022 .

[4]  Steven Dubowsky,et al.  Global time optimal motions of robotic manipulators in the presence of obstacles , 1988, Proceedings. 1988 IEEE International Conference on Robotics and Automation.

[5]  Michel Taïx,et al.  Efficient motion planners for nonholonomic mobile robots , 1991, Proceedings IROS '91:IEEE/RSJ International Workshop on Intelligent Robots and Systems '91.

[6]  Zoran Popovic,et al.  Motion warping , 1995, SIGGRAPH.

[7]  Michael Gleicher,et al.  Retargetting motion to new characters , 1998, SIGGRAPH.

[8]  J. Betts.  Survey of Numerical Methods for Trajectory Optimization , 1998 .

[9]  Mitul Saha,et al.  Exact Collision Checking of Robot Paths , 2002, WAFR.

[10]  Jean-Claude Latombe,et al.  On Delaying Collision Checking in PRM Planning: Application to Multi-Robot Coordination , 2002, Int. J. Robotics Res..

[11]  O. Brock,et al.  Elastic Strips: A Framework for Motion Generation in Human Environments , 2002, Int. J. Robotics Res..

[12]  Aaron Hertzmann,et al.  Style-based inverse kinematics , 2004, SIGGRAPH 2004.

[13]  Aaron Hertzmann,et al.  Style-based inverse kinematics , 2004, ACM Trans. Graph..

[14]  Katsu Yamane,et al.  Synthesizing animations of human manipulation tasks , 2004, SIGGRAPH 2004.

[15]  Timothy W. McLain,et al.  Real-time dynamic trajectory smoothing for unmanned air vehicles , 2005, IEEE Transactions on Control Systems Technology.

[16]  Steve C. Maddock,et al.  Adapting motion capture data using weighted real-time inverse kinematics , 2005, CIE.

[17]  C. Karen Liu,et al.  Learning physics-based motion style with nonlinear inverse optimization , 2005, ACM Trans. Graph..

[18]  Howie Choset,et al.  Principles of Robot Motion: Theory, Algorithms, and Implementation ERRATA!!!! 1 , 2007 .

[19]  Timothy Bretl,et al.  Using Motion Primitives in Probabilistic Sample-Based Planning for Humanoid Robots , 2008, WAFR.

[20]  Marc Toussaint,et al.  Optimization of sequential attractor-based movement for compact behaviour generation , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[21]  Mark H. Overmars,et al.  Creating High-quality Paths for Motion Planning , 2007, Int. J. Robotics Res..

[22]  D. Thalmann,et al.  Planning collision-free reaching motions for interactive object manipulation and grasping , 2008, SIGGRAPH '08.

[23]  Victor Ng-Thow-Hing,et al.  Randomized multi-modal motion planning for a humanoid robot manipulation task , 2011, Int. J. Robotics Res..