En faisant un goto début dans chaque branche de tes if then else, tu court-cicuites loop et les commandes moteur et les acquisitions capteur ne sont exécutés qu'une seule fois au tout début.
Donc c'est normal que ça ne fonctionne pas.
retire le label debut: et tous les goto