int Trig = 26;
int Echo = 27;
int Red = 12;
int Yellow = 13;
int Green = 14;
int distance;
void setup() {
// put your setup code here, to run once:
Serial.begin(115200);
pinMode(Trig, OUTPUT);
pinMode(Echo, INPUT);
pinMode(Red, OUTPUT);
pinMode(Yellow, OUTPUT);
pinMode(Green, OUTPUT);
}
void loop() {
digitalWrite(Trig, HIGH);
delay(100);
digitalWrite(Trig, LOW);
int reading =(pulseIn(Echo,HIGH));
distance = (reading*0.034/2)+1;
if (distance>300)
{
digitalWrite(Green, HIGH);
digitalWrite(Yellow, LOW);
digitalWrite(Red, LOW);
}
else if (distance>200)
{
digitalWrite(Green, LOW);
digitalWrite(Yellow, HIGH);
digitalWrite(Red, LOW);
}
else if (distance<101)
{
digitalWrite(Green, LOW);
digitalWrite(Yellow, LOW);
digitalWrite(Red, HIGH);
}
Serial.println(distance);
}