#define TRIG 7
#define ECHO 6
long duration;
int distance;
void setup() {
pinMode(TRIG, OUTPUT);
pinMode(ECHO, INPUT);
Serial.begin(9600);
}
void loop() {
  // put your main code here, to run repeatedly:
digitalWrite(TRIG, LOW);
delayMicroseconds(2);

digitalWrite(TRIG, HIGH);
delayMicroseconds(10);

digitalWrite(TRIG, LOW);
duration = pulseIn(ECHO, HIGH);

// Tính khoảng cách theo công thức: khoảng cách = (thời gian x tốc độ âm thanh) / 2
distance = 0.0343 * duration / 2;

Serial.print("Khoảng cách: ");
Serial.print(distance);
Serial.println(" cm");

delay(1000);
}