Gestion des obstacles avec contrôles

Un tutoriel en langage Arduino pour faire avancer le robot sur une distance donner avec la gestion des obstacles.

Voici un programme d’exemple:

Lecture du capteur de distance
Si il y a un obstacle devant le robot (distance < 70 mm) alors
le robot s’arrête et allume la led droite
Sinon, le robot avance de 200 mm

#include <mrduino2.h>

int capteur;

void setup() 
{
  // initialisation du robot
  initRobot();
}

void loop()
{

  // lecture du capteur
  capteur = proxSensor();

  if(capteur < 70)
  {
     // arrêt du robot
     stop();
     ledRight(1);

     delay(2000);
  }
  else
  {
    ledRight(0);
    
    // avancer de 200 mm
    forwardmm(10,200);
  }
}