Jérôme Barraquand Pierre Ferbach Path Planning Through Variational Dynamic Programming. 1839-1846 1994 ICRA db/conf/icra/icra1994-3.html#BarraquandF94a