[Mise à jour] : Mise en place de Lagrange en version bridée
[A faire] : Modification de la tranjectoire de la courbe si un état
bouge