G. Oriolo, P. Peliti, and M. Vendittelli, “A kinodynamic approach to task-constrained motion planning”, DIS Technical Reports, vol. 1, no. 4, Apr. 2009.