Optimisation numérique pour la robotique et exécution de trajectoires référencées capteurs