Thứ Ba, 20 tháng 6, 2017

Module cảm biến đo khoảng cách HC-SR04

Cảm biến khoảng cách siêu âm HC-SR04 được sử dụng rất phổ biến để xác định khoảng cách vì RẺ và CHÍNH XÁC. Cảm biến sử dụng sóng siêu âm và có thể đo khoảng cách trong khoảng từ 2 -> 300 cm, với độ chính xác gần như chỉ phụ thuộc vào cách lập trình.
Cảm biến HC-SR04 có 4 chân là: Vcc, Trig, Echo, GND.
Vcc5V
TrigMột chân Digital output
EchoMột chân Digital input
GNDGND
Sơ đồ nối chân giữa HC-SR04 và Arduino

Nguyên lý hoạt động

Để đo khoảng cách, ta sẽ phát 1 xung rất ngắn (5 microSeconds - ú) từ chân Trig. Sau đó, cảm biến sẽ tạo ra 1 xung HIGH ở chân Echo cho đến khi nhận lại được sóng phản xạ ở pin này. Chiều rộng của xung sẽ bằng với thời gian sóng siêu âm được phát từ cảm biển và quay trở lại. 
Tốc độ của âm thanh trong không khí là 340 m/s (hằng số vật lý), tương đương với 29,412 microSeconds/cm (106 / (340*100)). Khi đã tính được thời gian, ta sẽ chia cho 29,412 để nhận được khoảng cách.

4. Lắp mạch


5. Lập trình


  1. const int trig = 8; // chân trig của HC-SR04

  2. const int echo = 7; // chân echo của HC-SR04

  3. void setup()

  4. {

  5. Serial.begin(9600); // giao tiếp Serial với baudrate 9600

  6. pinMode(trig,OUTPUT); // chân trig sẽ phát tín hiệu

  7. pinMode(echo,INPUT); // chân echo sẽ nhận tín hiệu

  8. }

  9.  

  10. void loop()

  11. {

  12. unsigned long duration; // biến đo thời gian

  13. int distance; // biến lưu khoảng cách


  14. /* Phát xung từ chân trig */

  15. digitalWrite(trig,0); // tắt chân trig

  16. delayMicroseconds(2);

  17. digitalWrite(trig,1); // phát xung từ chân trig

  18. delayMicroseconds(5); // xung có độ dài 5 microSeconds

  19. digitalWrite(trig,0); // tắt chân trig


  20. /* Tính toán thời gian */

  21. // Đo độ rộng xung HIGH ở chân echo.

  22. duration = pulseIn(echo,HIGH);

  23. // Tính khoảng cách đến vật.

  24. distance = int(duration/2/29.412);


  25. /* In kết quả ra Serial Monitor */

  26. Serial.print(distance);

  27. Serial.println("cm");

  28. delay(200);

  29. }


Giải thích

- duration = pulseIn(echo,1);
Hàm pulseIn() được dùng để đo độ rộng của xung, các bạn có thể xem thêm tại link sau: http://arduino.vn/reference/pulsein.... Duration sẽ bằng độ dài xung HIGH ở chân echo (tính theo micro giây).
- distance = int(duration/2/29.412);
Thời gian sóng truyền từ cảm biến đến vật sẽ bằng duration/2, sau đó ta chia tiếp cho 29,412 để tính khoảng cách.

Không có nhận xét nào:

Đăng nhận xét

Món sắn dây và cháo Chai