int ledG = 2;
int ledY = 3;
int ledR = 4;
int ledB = 5;
int ledW = 6;
int echo = 12;
int trig = 13;
int time, dist;
void setup() {
pinMode(ledG, OUTPUT);
pinMode(ledY, OUTPUT);
pinMode(ledR, OUTPUT);
pinMode(ledB, OUTPUT);
pinMode(ledW, OUTPUT);
pinMode(trig, OUTPUT);
pinMode(echo, INPUT);
}
void loop() {
digitalWrite(trig, LOW);
delayMicroseconds(2);
digitalWrite(trig, HIGH);
delayMicroseconds(10);
digitalWrite(trig, LOW);
time = pulseIn(echo, HIGH);
dist = (time / 2) / 29.1;
if (dist < 200) {
digitalWrite(ledG, HIGH);
digitalWrite(ledY, HIGH);
digitalWrite(ledR, HIGH);
digitalWrite(ledB, HIGH);
digitalWrite(ledW, HIGH);
delay(150);
digitalWrite(ledG, LOW);
digitalWrite(ledY, LOW);
digitalWrite(ledR, LOW);
digitalWrite(ledB, LOW);
digitalWrite(ledW, LOW);
delay(1000);
}
}