35 lines
882 B
C++
35 lines
882 B
C++
//Définition des constanntes
|
|
// PIN Echo
|
|
const int EchoPin = 8;
|
|
// PIN Trigger
|
|
const int TriggerPin = 9;
|
|
|
|
void setup() {
|
|
Serial.begin(9600);
|
|
pinMode(TriggerPin, OUTPUT);
|
|
pinMode(EchoPin, INPUT);
|
|
}
|
|
|
|
void loop() {
|
|
int cm = ping(TriggerPin, EchoPin);
|
|
Serial.print("Distance mesurée : ");
|
|
Serial.println(cm);
|
|
delay(1000); // 1 s
|
|
}
|
|
|
|
//Calculer la distance
|
|
int ping(int TriggerPin, int EchoPin) {
|
|
long duration, distanceCm;
|
|
|
|
digitalWrite(TriggerPin, LOW); //Démarrage de la séquence de 4 µs
|
|
delayMicroseconds(4);
|
|
digitalWrite(TriggerPin, HIGH); // Impulsion de déclenchement 10 µs
|
|
delayMicroseconds(10);
|
|
digitalWrite(TriggerPin, LOW); // Arrêt de l'impulsion
|
|
|
|
duration = pulseIn(EchoPin, HIGH); // Émission du signal et lecture
|
|
|
|
distanceCm = duration * 10 / 292/ 2; // Vitesse du son converti en cm
|
|
return distanceCm;
|
|
}
|