Un tutoriel en langage Arduino pour lire le capteur de distance du robot MRduino2. Le capteur de distance est situé à l’avant du robot. La distance de lecture du capteur est en millimètre.

Simple lecture

Un programme pour lire le capteur et envoi du résultat sur le port série.

#include <mrduino2.h>

int capteur;

void setup()
{
initRobot();

}

void loop()
{
capteur = proxSensor();

Serial.print("Capteur=");
Serial.println(capteur);

delay(1000);
}

Le résultat sur le moniteur du logiciel Arduino (baud 115200):

Arrêt si obstacle

Un programme permettant de faire avancer le robot s’il n’y a pas d’obstacle sinon le robot s’arrête. La distance est fixée à 50 mm.

#include <mrduino2.h>

int capteur;

void setup()
{

initRobot();

}

void loop()
{

capteur = proxSensor();

 if(capteur > 50)
 {
   forward(25);// avancer pas d'obstacle 
 }
 else
 {
   stop();
 }
}

Fin du tutoriel.