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

 1
 2
 3
 4
 5
 6
 7
 8
 9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47

#define TRIG_PIN 8    // Chân Trig nối với chân 8
#define ECHO_PIN 7    // Chân Echo nối với chân 7
#define TIME_OUT 5000 // Time_out của pulseIn là 5000 microsecond

 // Chương trình con 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 lại chân Echo
  duration = pulseIn(ECHO_PIN, HIGH, TIME_OUT);
 
  // Tính khoảng cách 
  distanceCm = duration / 29.1 / 2;
  // trả lại giá trịnh tính được
  return distanceCm;
}
 
void setup() {  
  Serial.begin(9600);
 
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
}
 
void loop() {
  // gọi chương trình con getDistance
  long distance = getDistance();
 
  if (distance <= 0)
  {
    Serial.println("Echo time out !!"); // nếu thời gian phản hồi vượt quá Time_out của hàm pulseIn
  }
  else
  {
    // Hiển thị khoảng cách đo được lên Serial Monitor   
    Serial.print("Distance to nearest obstacle (cm): ");
    Serial.println(distance);
  }
  // Chờ 1s và lặp lại cu kỳ trên
  delay(1000);
}