#define  TRIG 7  
#define  ECHO 6
long thoigian ;
int khoangcach ;
float vantoc = 0.0343; // 0.034 là tốc độ của sóng siêu âm trong không khí , 0.034 cm/micro giây  
void setup() {
  // put your setup code here, to run once:
pinMode(TRIG,OUTPUT);
pinMode(ECHO, INPUT);
Serial.begin(9600);
}

void loop() {
  // put your main code here, to run repeatedly:
// Đặt TRIG ở mức LOW trong thời gian 2 micro giây 
digitalWrite(TRIG, LOW);
delay(2);
// Đặt TRIG ở mức HIGH trong thời gian 10 micro giây để phát sóng sisu âm 
digitalWrite(TRIG, HIGH);
delay(10);
// Đặt chân TRIG ở mức LOW lại 
digitalWrite(TRIG, LOW);
// đặt thời gian Echo pin ở mức cao , tức là thời gian sóng siêu âm đi và về
thoigian = pulseIn(ECHO,HIGH);//đơn vị là micro giây là thời gian bắt đầu phát sóng đén lúc phản xạ lại 

khoangcach = 0.0343 * thoigian/2;

Serial.print(khoangcach);
delay (1000);
}