#define ledBlue 26
#define ledRed 25
int trigPin=23;
int echoPin=22;
long duration;
int distance;
void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
pinMode(ledBlue, OUTPUT);
pinMode(ledRed, OUTPUT);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
}

void loop() {
  // put your main code here, to run repeatedly:
  ultrasonic();
  delay(1000); // this speeds up the simulation
}
void ultrasonic(){
  digitalWrite(trigPin, LOW);
  delay(2);
  digitalWrite(trigPin, HIGH);
  delay(10);
  digitalWrite(trigPin, LOW);
  duration=pulseIn(echoPin,HIGH);
  distance=duration*0.034/2;
  Serial.print("Distance: ");
  Serial.println(distance);
  if(distance<25){
    digitalWrite(ledBlue, HIGH);
    digitalWrite(ledRed, HIGH);
    delay(1000);
    digitalWrite(ledBlue, LOW);
    digitalWrite(ledRed, LOW);
    delay(1000);

  }else if(distance>=25 && distance<100){
    digitalWrite(ledBlue, HIGH);
    digitalWrite(ledRed, HIGH);
    delay(500);
    digitalWrite(ledBlue, LOW);
    digitalWrite(ledRed, LOW);
    delay(500); 
  }else if(distance>=100 && distance<200){
    digitalWrite(ledBlue, HIGH);
    digitalWrite(ledRed, HIGH);
    delay(200);
    digitalWrite(ledBlue, LOW);
    digitalWrite(ledRed, LOW);
    delay(200); 
  }else {
    digitalWrite(ledBlue, HIGH);
    digitalWrite(ledRed, HIGH);
  }
}