#include <LiquidCrystal_I2C.h>

LiquidCrystal_I2C lcd (0x27, 16, 2);

int TrigPin = 5;
int EchoPin = 6;

int Duration;
float D_cm;

void setup() {
  pinMode(TrigPin, OUTPUT);
  pinMode(EchoPin, INPUT);

  lcd.init();
  lcd.backlight();
  lcd.setBacklight(HIGH);
}

void loop() {
  //phát sóng siêu âm có giá trị là 10ms (microseconds)
  //digitalWrite(TrigPin, LOW);
  //delayMicroseconds(2);
  digitalWrite(TrigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(TrigPin, LOW);

  //Nhận giá trị phản hồi
  Duration = pulseIn(EchoPin, HIGH);

  //Tính khoảng cách đến vật thể
  //Ta có: Vận tốc sóng siêu âm trong môi trường không khí là V = 340m/s <=> V = 0.034 cm/ms
  //D = Duration * 0.034 / 2 (chia 2 là do quá trình phản xạ sóng siêu âm)
  D_cm = Duration * 0.034 / 2.0;

  //in kết quả
  lcd.setCursor(0, 0);
  lcd.print("Duration: ");
  lcd.print(Duration);
  lcd.setCursor(0, 1);
  lcd.print("D = ");
  lcd.print(D_cm);
  lcd.print("cm");
  delay(2000);
}