// Rama Haddaf Syachriza
// 2021230002
//kamis 28/03/2024

//Bekerja dengan sensor ultrasonik HC-SR04

#define ECHO_PIN 2
#define TRIG_PIN 15

int ledBiruPin = 4;
int ledHijauPin = 16;
int ledKuningPin = 5;
int ledMerahPin = 18;
int buzzerPin = 17;

void setup() {
Serial.begin(115200);
pinMode(TRIG_PIN, OUTPUT);
pinMode(ECHO_PIN, INPUT);
pinMode(ledBiruPin, OUTPUT);
pinMode(ledHijauPin, OUTPUT);
pinMode(ledKuningPin, OUTPUT);
pinMode(ledMerahPin, OUTPUT);
}

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

void loop() {
digitalWrite(TRIG_PIN, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PIN, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN, LOW);
int duration = pulseIn(ECHO_PIN, HIGH);
float distance = duration * 0.034 / 2;
//float distance = readDistanceCM();

  if (distance >= 50 && distance <= 99) {
    digitalWrite(ledBiruPin, HIGH);
    digitalWrite(ledHijauPin, LOW);
    digitalWrite(ledKuningPin, LOW);
    digitalWrite(ledMerahPin, LOW);
    digitalWrite(buzzerPin, LOW); // Matikan buzzer
  } else if (distance >= 100 && distance <= 199) {
    digitalWrite(ledBiruPin, HIGH);
    digitalWrite(ledHijauPin, HIGH);
    digitalWrite(ledKuningPin, LOW);
    digitalWrite(ledMerahPin, LOW);
    digitalWrite(buzzerPin, LOW); // Matikan buzzer
  } else if (distance >= 200 && distance <= 299) {
    digitalWrite(ledBiruPin, HIGH);
    digitalWrite(ledHijauPin, HIGH);
    digitalWrite(ledKuningPin, HIGH);
    digitalWrite(ledMerahPin, LOW);
    digitalWrite(buzzerPin, LOW); // Matikan buzzer
  } else if (distance >= 300) {
    digitalWrite(ledBiruPin, HIGH);
    digitalWrite(ledKuningPin, HIGH);
    digitalWrite(ledHijauPin, HIGH);
    digitalWrite(ledMerahPin, HIGH);
    tone(buzzerPin, 400); // Aktifkan buzzer dengan frekuensi 400Hz
  }
Serial.print("Jarak: ");
Serial.println(distance);
delay(100);
}