int trig = 25;
int echo = 26;
long dura;
long dist;
int trig2 = 4,but;
int echo2 = 2;
long dura2,comp2;
long dist2,comp1;
void setup() {
// put your setup code here, to run once:
Serial.begin(115200);
pinMode(trig, OUTPUT);
pinMode(echo, INPUT);
pinMode(trig2, OUTPUT);
pinMode(echo2, INPUT);
pinMode(14, OUTPUT);
pinMode(15, OUTPUT);
pinMode(12, OUTPUT);
pinMode(5, OUTPUT);
}
long distfun(){
digitalWrite(trig, LOW);
delay(500);
digitalWrite(trig, HIGH);
delay(500);
digitalWrite(trig, LOW);
dura = pulseIn(echo,HIGH);
return(0.034 * dura / 2)+1;
}
long distfunc(){
digitalWrite(trig2, LOW);
delay(500);
digitalWrite(trig2, HIGH);
delay(500);
digitalWrite(trig2, LOW);
dura2 = pulseIn(echo2,HIGH);
return(0.034 * dura2 / 2)+1;
}
void loop() {
but=digitalRead(15);
comp2=distfun();
if(but==1)
{
digitalWrite(12, HIGH);
delay(1000);
comp1 = distfun();
}
else{
digitalWrite(12,LOW);
}
if(comp1 > comp2)
{
digitalWrite(5, HIGH);
}
else{
digitalWrite(5, LOW);
}
}