Vous êtes sur la page 1sur 2

Programmation du capteur ultrason :

// Définir les constantes et variables pour le capteur HC-SR04


int trigPin = 4; // indique que la fiche Trig du capteur est sur la broche : PIN 4
int echoPin = 5; // indique que la fiche Echo du capteur est sur la broche : PIN 5

float ping()
{
// send a 10us+ pulse
digitalWrite(trigPin, LOW);
delayMicroseconds(20);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
delayMicroseconds(20);

// read duration of echo


int duration = pulseIn(echoPin, HIGH);

// dist = duration * speed of sound * 1/2


// dist in cm = duration in us * 1 x 10^{-6} * 340.26 * 100 * 1/2
// = 0.017*duration
float dist = 0.017 * duration;

return dist;

void setup()
{
// définir les PIN du capteur pour savoir si c'est des entrées ou des sorties
pinMode(trigPin, OUTPUT); // indique que la broche TrigPin est une sortie
pinMode(echoPin, INPUT); // indique que la broche EchoPin est ne entrée
}

void loop()
{
float dist = ping();

if (dist > 0 && dist < 25) {

arreter();
delay (1000);
marche_Arriere();
delay (1000);
tourner_Droite();
delay (1000);
marche_Avant();
delay(1000);
}

else {
marche_Avant();
delay(800);
}
}

Vous aimerez peut-être aussi