#include <Wire.h>
#include <LiquidCrystal_I2C.h>;
LiquidCrystal_I2C lcd(0x27,16,2);
 int ledPin3 = 3;
 int ledPin2 = 2;
 int ledPin1 = 1;


const int trigPin = 5;   // Khai báo chân trigger của cảm biến
const int echoPin = 6;  // Khai báo chân echo của cảm biến


void setup() {


  lcd.init();       
  lcd.backlight();     // Khởi động giao tiếp Serial với tốc độ baud 9600
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode (ledPin1, OUTPUT);
  pinMode (ledPin2, OUTPUT);
  pinMode (ledPin3, OUTPUT);
}

void loop() {
  long duration, distance;
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  duration = pulseIn(echoPin, HIGH);
  distance = duration / 58.2; // tính khoảng cách dựa trên thời gian với tốc độ âm thanh 340 m/s
  
  lcd.setCursor(0,0);
  lcd.print(distance);
  lcd.print(" cm");
 if (distance < 10)
  {
    digitalWrite(ledPin1, 1);
    digitalWrite(ledPin2, 0);
    digitalWrite(ledPin3, 0);
  }
    if (distance < 20 && distance > 10)
  {
    digitalWrite(ledPin1, 0);
    digitalWrite(ledPin2, 1);
    digitalWrite(ledPin3, 0);
  }
    if (distance < 30 && distance > 20)
  {
    digitalWrite(ledPin1, 0);
    digitalWrite(ledPin2, 0);
    digitalWrite(ledPin3, 1);
  }
   if (distance > 30)
  {
    digitalWrite(ledPin1, 0);
    digitalWrite(ledPin2, 0);
    digitalWrite(ledPin3, 0);
  }
  
   if (distance < 20)
  {
    lcd.setCursor(0, 1);
    lcd.print("danger");
  } else {
    
    lcd.setCursor(0, 1);
   lcd.print("safe  ");
  }
  
  

  
  delay(500); // chờ 0.5 giây trước khi thực hiện lại lệnh
}