#define TRIG_PIN 12  // Chân Trig của HC-SR04
#define ECHO_PIN 13  // Chân Echo của HC-SR04

void setup() {
  Serial.begin(115200); // Khởi động Serial để debug
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
}

void loop() {
  long duration, distance;
  
  // Phát tín hiệu Trig
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  
  // Đo thời gian Echo
  duration = pulseIn(ECHO_PIN, HIGH);
  
  // Tính khoảng cách (cm)
  distance = duration * 0.034 / 2;

  // In kết quả ra Serial Monitor
  Serial.print("Khoảng cách: ");
  Serial.print(distance);
  Serial.println(" cm");
  
  delay(500); // Đợi 500ms trước khi đo lần tiếp theo
}