const int trig = 25;     // chân trig của HC-SR04
const int echo = 33;     // chân echo của HC-SR04

void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  pinMode(12, OUTPUT);
  pinMode(14, INPUT);
  pinMode(trig,OUTPUT);   // chân trig sẽ phát tín hiệu
  pinMode(echo,INPUT);    // chân echo sẽ nhận tín hiệu
}

void loop() {
  unsigned long duration; // biến đo thời gian
  int distance;           // biến lưu khoảng cách
  int a;
  digitalWrite(trig,0);   // tắt chân trig
    delayMicroseconds(2);
    digitalWrite(trig,1);   // phát xung từ chân trig
    delayMicroseconds(5);   // xung có độ dài 5 microSeconds
    digitalWrite(trig,0);   // tắt chân trig
    
    /* Tính toán thời gian */
    // Đo độ rộng xung HIGH ở chân echo. 
    duration = pulseIn(echo,HIGH);  
    // Tính khoảng cách đến vật.
    distance = int(duration/2/29.35);
  a = digitalRead(14);
  if(distance <=100)
    digitalWrite(12, HIGH);
  else if (distance >100)
    digitalWrite(12, LOW);
  Serial.println(distance);
  // put your main code here, to run repeatedly:
  delay(1000); // this speeds up the simulation
}