Étape 3: Code
Il s’agit de l’esquisse de celui-ci.
Certains code et câblage inspiré par http://en.wikiversity.org/wiki/User:Dstaub/robotcar * /
#define trigPin 13 #define echoPin #define 12 led 11 #define led2 #define 10 buzzer 9
void setup() {Serial.begin (9600); pinMode (trigPin, sortie); pinMode (echoPin, INPUT); pinMode (led, sortie); pinMode (led2, sortie); pinMode (vibreur, OUTPUT);}
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 ; si (distance < 50) {digitalWrite(led,HIGH) ; digitalWrite(buzzer,HIGH) ; digitalWrite(led2,LOW) ;
} else {digitalWrite(led,LOW) ; digitalWrite(buzzer,LOW) ; digitalWrite(led2,HIGH);} si (distance > = 200 || distance < = 0) {Serial.println ("out of range");} else {Serial.print(distance) ; Serial.println ("cm") ; } delay(800) ;