Stap 4: Code (veel plezier!)
/*
HC-SR04 Ping afstandssensor VCC met Arduino 5V GND Arduino GND ECHO aan Arduino pin 13 Trig Arduino pin 12 Motor Arduino pin 3 originele code verbeteringen op de Ping schets afkomstig uit Trollmaker.com wat code en bedrading geïnspireerd door http://en.wikiversity.org/wiki/User:Dstaub/robotcar gewijzigd door Tolson Winters (27 Aug, 2014) voor vereenvoudigde seriële monitor lezen. Gewijzigd door Anthony Pease (9 Nov, 2015) voor motor interactie * /
#define trigPin 12 #define echoPin 13 #define moterPin 3
Const int motorPin = 3;
void setup {Serial.begin (9600); pinMode (trigPin, OUTPUT); pinMode (echoPin, INPUT); pinMode (motorPin, OUTPUT);
}
void loop {lange duur, afstand digitalWrite (trigPin, laag); delayMicroseconds(2); digitalWrite (trigPin, hoge); delayMicroseconds(10); digitalWrite (trigPin, laag); duur = pulseIn (echoPin, hoge); afstand = (duur/2) / 29.1;
Serial.Print ("In bereik:"); Serial.Print(distance); Serial.println ("cm");
Als (afstand < = 45 & & afstand > = 2) {Serial.print ("actief"); digitalWrite (motorPin, hoge); delay(100); } else {digitalWrite (motorPin, laag); delay(100);} delay(100); }