Étape 4: Code (Amusez-vous!)
/*
Capteur de distance HC-SR04 Ping VCC pour Arduino 5V GND pour Arduino GND Echo à Arduino pin 13 Trig pour goupille de Arduino 12 moteur à esquisser des améliorations à la commande Ping du code Original pin 3 Arduino provenant de Trollmaker.com peu de code et câblage inspiré par http://en.wikiversity.org/wiki/User:Dstaub/robotcar modifié par Tolson hivers (27 août 2014) pour moniteur série simplifiée de lecture. Modifié par Anthony Pease (9 novembre 2015) pour l’interaction moteur * /
#define trigPin 12 #define echoPin 13 #define moterPin 3
const int motorPin = 3 ;
void setup() {Serial.begin (9600); pinMode (trigPin, sortie); pinMode (echoPin, INPUT); pinMode (motorPin, sortie) ;
}
void loop() {longue durée, la distance digitalWrite (trigPin, basse); delayMicroseconds(2) ; digitalWrite (trigPin, HIGH); delayMicroseconds(10) ; digitalWrite (trigPin, LOW); durée = pulseIn (echoPin, HIGH); distance = (durée/2) / 29,1 ;
Serial.Print ("dans la gamme:") ; Serial.Print(distance) ; Serial.println ("cm") ;
Si (distance < = 45 & & distance > = 2) {Serial.print ("Active") ; digitalWrite (motorPin, HIGH) ; Delay(100) ; } else {digitalWrite (motorPin, LOW); delay(100);} delay(100) ; }