int trigger = 12;
int echo = 13;
float distance;
void setup() {
// put your setup code here, to run once:
Serial.begin(115200);
pinMode(trigger, OUTPUT);
pinMode(echo, INPUT);
pinMode(19, OUTPUT);
pinMode(15, OUTPUT);
pinMode(22, OUTPUT);
}
int uf(){
digitalWrite(trigger, LOW);
delay(10);
digitalWrite(trigger, HIGH);
delay(100);
digitalWrite(trigger, LOW);
distance=pulseIn(echo, HIGH);
return (distance*0.034/2)+1;
}
void loop() {
Serial.println(uf());
if(uf()>0 && uf()<100){
digitalWrite(19, HIGH);
digitalWrite(15, LOW);
digitalWrite(22, LOW);
}
else if(uf()>100 && uf()<200)
{
digitalWrite(15, HIGH);
digitalWrite(19, LOW);
digitalWrite(22, LOW);
}
else if(uf()>200 && uf()<400)
{
digitalWrite(22, HIGH);
digitalWrite(19, LOW);
digitalWrite(15, LOW);
}
else {
digitalWrite(19, LOW);
digitalWrite(15, LOW);
digitalWrite(22, LOW);
}
}