Arduino Ultrasonic Sensor (3 / 4 steg)
Steg 3: Skriv koden
#define trigPin 13
#define echoPin 12
#define greenLED 11
#define redLED 10
void setup() {
Serial.BEGIN (9600);
pinMode (trigPin, produktionen);
pinMode (echoPin, ingång);
pinMode (greenLED, produktionen);
pinMode (redLED, 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åndet = (längd/2) / 29,1;
om (distanserar < 4) {/ / Detta är där LED på/av händer
digitalWrite(greenLED,HIGH); När röda villkoret är uppfyllt, skulle grön LED stänga av digitalWrite(redLED,LOW);
} annat {
digitalWrite(greenLED,LOW); digitalWrite(redLED,HIGH);
}
om (avstånd > = 200 || avstånd < = 0) {
Serial.println ("out of range");
} annat {
Serial.Print(Distance); Serial.println ("cm");
} delay(500);
}