Bailin Cao Gordon I. Dodds George W. Irwin Time-Optimal and Smooth Constrained Path Planning for Robot Manipulators. 1853-1858 1994 ICRA db/conf/icra/icra1994-3.html#CaoDI94