#include <LiquidCrystal_I2C.h>

const int trigPin = 2;
const int echoPin = 3;
const int buzzerPin = 4;
const int greenLedPin = 5;  // Define green LED pin
const int yellowLedPin = 6; // Define yellow LED pin
const int redLedPin = 7;    // Define red LED pin

LiquidCrystal_I2C lcd(0x27, 16, 2);

void setup() {
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(buzzerPin, OUTPUT);
  pinMode(greenLedPin, OUTPUT);  // Set green LED pin as output
  pinMode(yellowLedPin, OUTPUT); // Set yellow LED pin as output
  pinMode(redLedPin, OUTPUT);    // Set red LED pin as output

  lcd.begin(16, 2);
  lcd.print("Distance: ");
}

void loop() {
  long duration, cm;

  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);

  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  duration = pulseIn(echoPin, HIGH);

  cm = duration * 0.034 / 2;

  lcd.setCursor(0, 1);
  lcd.print("     ");
  lcd.setCursor(0, 1);
  lcd.print(cm);
  lcd.print(" cm");

  if (cm >= 61 && cm <= 180) {
    // Turn on green LED
    digitalWrite(greenLedPin, HIGH);
    // Turn off other LEDs
    digitalWrite(yellowLedPin, LOW);
    digitalWrite(redLedPin, LOW);
    // Beep the buzzer repeatedly
   beep(5);
tone(buzzerPin, 1000, 500);
  } else if (cm >= 31 && cm <= 60) {
    // Turn on yellow LED
    digitalWrite(yellowLedPin, HIGH);
    // Turn off other LEDs
    digitalWrite(greenLedPin, LOW);
    digitalWrite(redLedPin, LOW);
    beep(2);
tone(buzzerPin, 1000, 500);
  } else if (cm >= 0 && cm <= 30) {
    // Turn on red LED
    digitalWrite(redLedPin, HIGH);
    // Turn off other LEDs
    digitalWrite(greenLedPin, LOW);
    digitalWrite(yellowLedPin, LOW);
    // Beep the buzzer once
   beep(1);
   tone(buzzerPin, 1000, 500);
  } else {
    // No action
    digitalWrite(buzzerPin, LOW);
    digitalWrite(greenLedPin, LOW);
    digitalWrite(yellowLedPin, LOW);
    digitalWrite(redLedPin, LOW);
  }

  // Delay between distance measurements
  delay(100);
}

// Function to beep the buzzer a specified number of times
void beep(int times) {
  for (int i = 0; i < times; i++) {
    digitalWrite(buzzerPin, HIGH);
    delay(200);
    digitalWrite(buzzerPin, LOW);
    delay(200);
  }
}

// ใครก็อปขอให้ขี้แตก rush 28 1/5