const int TRIG_PIN =26;
const int ECHO_PIN =25;
int l1=19;
int l2=18;
int l3=5;
long duration, distance;
void setup()
{
Serial.begin(115200);
pinMode(TRIG_PIN, OUTPUT);
pinMode(ECHO_PIN, INPUT);
pinMode(l1, OUTPUT);
pinMode(l2, OUTPUT);
pinMode(l3, OUTPUT);
}
void loop()
{
distance = getDistanceInCentimeters();
Serial.println("Distance = "+ String(distance));
delay(1000);
if(distance>100)
{
digitalWrite(l1, HIGH);
}
else
{
digitalWrite(l1, LOW);
}
if(distance>200)
{
digitalWrite(l1, HIGH);
digitalWrite(l2, HIGH);
}
else
{
digitalWrite(l1, LOW);
digitalWrite(l2, LOW);
}
if(distance>300)
{
digitalWrite(l1, HIGH);
digitalWrite(l2, HIGH);
digitalWrite(l3, HIGH);
}
else
{
digitalWrite(l1, LOW);
digitalWrite(l2, LOW);
digitalWrite(l3, LOW);
}
}
long getDistanceInCentimeters()
{
digitalWrite(TRIG_PIN, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PIN, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN, LOW);
duration = pulseIn(ECHO_PIN, HIGH);
return (duration * 0.034 / 2) + 1;
}