#define ECHO_PIN_LEFT 3
#define TRIG_PIN_LEFT 2
#define LED_LEFT 4  // Assuming you connect the left LED to pin 4

#define ECHO_PIN_RIGHT 6
#define TRIG_PIN_RIGHT 5
#define LED_RIGHT 7  // Assuming you connect the right LED to pin 7

#define BUZZER_PIN 10

void setup() {
  Serial.begin(115200);
  pinMode(LED_LEFT, OUTPUT);
  pinMode(TRIG_PIN_LEFT, OUTPUT);
  pinMode(ECHO_PIN_LEFT, INPUT);
  
  pinMode(LED_RIGHT, OUTPUT);
  pinMode(TRIG_PIN_RIGHT, OUTPUT);
  pinMode(ECHO_PIN_RIGHT, INPUT);

  pinMode(BUZZER_PIN, OUTPUT); 
}

float readDistanceCM(int triggerPin, int echoPin) {
  digitalWrite(triggerPin, LOW);
  delayMicroseconds(2);
  digitalWrite(triggerPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(triggerPin, LOW);
  int duration = pulseIn(echoPin, HIGH);
  return duration * 0.034 / 2;
}

void loop() {
  float distanceLeft = readDistanceCM(TRIG_PIN_LEFT, ECHO_PIN_LEFT);
  float distanceRight = readDistanceCM(TRIG_PIN_RIGHT, ECHO_PIN_RIGHT);

  bool isNearbyLeft = distanceLeft < 100;
  bool isNearbyRight = distanceRight < 100;

  bool isCloseRight = distanceRight < 50;

  digitalWrite(LED_LEFT, isNearbyLeft);
  digitalWrite(LED_RIGHT, isNearbyRight);

  if(isCloseRight){
      digitalWrite(BUZZER_PIN, HIGH);
  } else {
    digitalWrite(BUZZER_PIN, LOW);
  }
  

  Serial.print("Measured distance (Left): ");
  Serial.println(distanceLeft);
  Serial.print("Measured distance (Right): ");
  Serial.println(distanceRight);

  delay(100);
}