int trigger=12;
int echo=14;
float distance;
void setup() {
Serial.begin(115200);
pinMode(trigger, OUTPUT);
pinMode(echo, INPUT);
pinMode(22, OUTPUT);
pinMode(26, OUTPUT);
pinMode(25, OUTPUT);
}
int ultraperformance(){
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() {
int actual_distance= ultraperformance();
Serial.println(actual_distance);// put your main code here, to run repeatedly:
if (actual_distance>300){
digitalWrite(26, HIGH);
digitalWrite(22, LOW);
digitalWrite(25, LOW);
}
else if (actual_distance>=200 && actual_distance>=200){
digitalWrite(25, HIGH);
digitalWrite(26, LOW);
digitalWrite(22, LOW);
}
else if (actual_distance>=0 && actual_distance<=200){
digitalWrite(22, HIGH);
digitalWrite(26, LOW);
digitalWrite(25, LOW);
}
delay(10); // this speeds up the simulation
}