Arduino ultrasone Sensor (3 / 4 stap)

Stap 3: Uw code schrijven

#define trigPin 13

#define echoPin 12

#define greenLED 11

#define redLED 10

VOID Setup {}

Serial.begin (9600);

pinMode (trigPin, OUTPUT);

pinMode (echoPin, INPUT);

pinMode (greenLED, OUTPUT);

pinMode (redLED, 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;

Als (afstand < 4) {/ / Dit is waar de LED on/off gebeurt

digitalWrite(greenLED,HIGH); Wanneer de rode voorwaarde wordt voldaan, moet de groene LED uitschakelen van digitalWrite(redLED,LOW);

} else {}

digitalWrite(greenLED,LOW); digitalWrite(redLED,HIGH);

}

Als (afstand > = 200 || afstand < = 0) {}

Serial.println ("buiten het bereik");

} else {}

Serial.Print(distance); Serial.println ("cm");

} delay(500);

}