#define ECHO_PIN1 15
#define TRIG_PIN1 2

#define ECHO_PIN2 5
#define TRIG_PIN2 18

#define ECHO_PIN3 26
#define TRIG_PIN3 27

#define ECHO_PIN4 33
#define TRIG_PIN4 32

int LEDPIN1 = 13;
int LEDPIN2 = 12;
int LEDPIN3 = 14;
int LEDPIN4 = 25;

void setup() {
  Serial.begin(115200);

  // Sensor 1
  pinMode(LEDPIN1, OUTPUT);
  pinMode(TRIG_PIN1, OUTPUT);
  pinMode(ECHO_PIN1, INPUT);

  // Sensor 2
  pinMode(LEDPIN2, OUTPUT);
  pinMode(TRIG_PIN2, OUTPUT);
  pinMode(ECHO_PIN2, INPUT);

  // Sensor 3
  pinMode(LEDPIN3, OUTPUT);
  pinMode(TRIG_PIN3, OUTPUT);
  pinMode(ECHO_PIN3, INPUT);

  // Sensor 4
  pinMode(LEDPIN4, OUTPUT);
  pinMode(TRIG_PIN4, OUTPUT);
  pinMode(ECHO_PIN4, INPUT);
}

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

void loop() {
  float distance1 = readDistanceCM(TRIG_PIN1, ECHO_PIN1);
  float distance2 = readDistanceCM(TRIG_PIN2, ECHO_PIN2);
  float distance3 = readDistanceCM(TRIG_PIN3, ECHO_PIN3);
  float distance4 = readDistanceCM(TRIG_PIN4, ECHO_PIN4);

  
  digitalWrite(LEDPIN1, distance1 >= 4);
  digitalWrite(LEDPIN2, distance2 >= 4);
  digitalWrite(LEDPIN3, distance3 >= 4);
  digitalWrite(LEDPIN4, distance4 >= 4);

  Serial.print("Distance 1: ");
  Serial.print(distance1);
  Serial.println(" cm");

  Serial.print("Distance 2: ");
  Serial.print(distance2);
  Serial.println(" cm");

  Serial.print("Distance 3: ");
  Serial.print(distance3);
  Serial.println(" cm");

  Serial.print("Distance 4: ");
  Serial.print(distance4);
  Serial.println(" cm");

  Serial.println("-------------------------");

  delay(500);
}