Hướng dẫn Module cảm biến siêu âm HY-SRF05

 

#define TRIG_PIN 8    // Chân Trig nối  chân 8
#define ECHO_PIN 7    // Chân Echo nối chân 7
#define TIME_OUT 5000 // Time_out  pulseIn : 5000 microsecond

 // Chương trình tính khoảng cách
float getDistance()
{
  long duration, distanceCm;
  // Phát 1 xung 10uS từ chân Trig 
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  // Thời gian tín hiệu phản hồi chân Echo
  duration = pulseIn(ECHO_PIN, HIGH, TIME_OUT);
 
  // Tính khoảng cách 
  distanceCm = duration / 29.1 / 2;
  // giá trịnh tính được
  return distanceCm;
}
 
void setup() {  
  Serial.begin(9600);
 
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
}
 
void loop() {
  // call chương trình getDistance
  long distance = getDistance();
 
  if (distance <= 0)
  {
    Serial.println("Echo time out !!"); // khi thời gian phản hồi vượt Time_out của hàm pulseIn
  }
  else
  {
    // Hiển thị khoảng cách đo được vào Serial Monitor   
    Serial.print("Distance to nearest obstacle (cm): ");
    Serial.println(distance);
  }
  // Chờ 1s sau đó lặp lại chu kỳ trên
  delay(1000);
}

Chúc bạn thành công.