réponse en vitesse OK pur des sauts de l'ordre de 0.2 m/s
reponse a echelon 0.5
Ajout des contraintes, pas encore refait les réglages