Déplacement du calcul de la vitesse à appliquer dans une fonction
dédiée, afin de pouvoir la réutiliser dans le cas du robot réel.