code source de ma version actuelle

ça ressort une matrice 3x1 pour la vitesse et 3x3 pour vitesse angulaire

appui sur q stoppe la boucle

Signed-off-by: Anis SEMMAR <anis.semmar@gmail.com>