Simultaneous path planning and trajectory optimization for robotic manipulators using discrete mechanics and optimal control
Z. Shareef, A. Trächtler, Robotica 34 (2016) 1322–1334.