Le cmd_vel semble fonctionner. Tests à faire.