Störningar ansökan (4 / 4 steg)
Steg 4: Kod (skoja!)
/*
HC-SR04 Ping avstånd sensor VCC till Arduino 5V GND till Arduino GND Echo till Arduino stift 13 Trig till Arduino stift 12 Motor till Arduino stift 3 ursprungliga koden förbättringar till Ping skiss kommer från Trollmaker.com lite kod och ledningar inspirerad av http://en.wikiversity.org/wiki/User:Dstaub/robotcar ändrad av Tolson vintrar (27 Aug 2014) för förenklade seriell övervaka läsning. Ändrat av Anthony Pease (9 Nov 2015) för motor interaktion * /
#define trigPin 12 #define echoPin 13 #define moterPin 3
CONST int motorPin = 3;
void setup() {Serial.begin (9600), pinMode (trigPin, produktionen), pinMode (echoPin, ingång), pinMode (motorPin, produktionen);
}
void loop() {lång varaktighet, avstånd, digitalWrite (trigPin, låg), delayMicroseconds(2); digitalWrite (trigPin, hög); delayMicroseconds(10); digitalWrite (trigPin, låg), längd = pulseIn (echoPin, hög), avstånd = (längd/2) / 29,1;
Serial.Print ("i urval:"); Serial.Print(Distance); Serial.println ("cm");
om (avstånd < = 45 & & avstånd > = 2) {Serial.print ("aktiva"); digitalWrite (motorPin, hög); Delay(100); } annat {digitalWrite (motorPin, låg); delay(100);} delay(100); }