// *** Mesure_US : Mesure distance par UltraSon et ecriture ***
// *** du resultat sur le port serie. ***
// ********************************************************
#define TRIG 7 // Definition de la broche ou est branche TRIGGER
#define ECHO 8 // Definition de la broche ou est branche ECHO
long lecture_echo;
long cm;
void setup() {
pinMode(TRIG, OUTPUT);
digitalWrite(TRIG, LOW);
pinMode(ECHO, INPUT);
Serial.begin(9600);
Serial.println (“Mesure de distance par Ultra Son”);
}
void loop() {
// Activation de la commande TRIGGER pendant 10ms : envoi d’un ping
digitalWrite(TRIG, HIGH); // Emission d’ultrasons
delayMicroseconds(10); // Attente 10ms
digitalWrite(TRIG, LOW); // Arret d’emission
lecture_echo = pulseIn(ECHO, HIGH); // lecture_echo correspond au temps d’attente de l’echo
cm = lecture_echo /58; // calcul de la distance a partir du temps mesure
// Affichage sur le flux serie de la distance mesuree
Serial.print(“Distance en cm :”);
Serial.println(cm);
delay(1500); // Attente de 1.5s entre deux mesures
}