Anca D. Dragan, Nathan D. Ratliff, Siddhartha S. Srinivasa. Manipulation planning with goal sets using constrained trajectory optimization. In IEEE International Conference on Robotics and Automation, ICRA 2011, Shanghai, China, 9-13 May 2011. pages 4582-4588, IEEE, 2011. [doi]