Time optimal trajectory planning for robotic manipulators with obstacle avoidance: A CAD approach S. Dubowsky, M. A. Norris, Z Shiller