#define trigPin 10
#define echoPin 11
void setup() {
// put your setup code here, to run once:
Serial.begin(9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
}
void loop() {
// put your main code here, to run repeatedly:
pinMode(5, OUTPUT);
pinMode(4, OUTPUT);
pinMode(3, OUTPUT);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
int dulation = pulseIn(echoPin, HIGH);
Serial.print("Distance in cm: ");
Serial.println(dulation / 58);
if (dulation / 58 > 300) {
digitalWrite(3, 1);
digitalWrite(4, 0);
digitalWrite(5, 0);
} else if (dulation / 58 > 200) {
digitalWrite(3, 0);
digitalWrite(4, 1);
digitalWrite(5, 0);
} else if (dulation / 58 > 100) {
digitalWrite(3, 0);
digitalWrite(4, 0);
digitalWrite(5, 1);
} else {
digitalWrite(3, 0);
digitalWrite(4, 0);
digitalWrite(5, 1);
delay(200);
digitalWrite(5, 0);
delay(200);
}
}