[CODE MẪU] ĐO KHOẢNG CÁCH VỚI CẢM BIẾN SIÊU ÂM HC-SR04 VÀ SRF05

Giới thiệu với các bạn code mẫu đo khoảng cách với cảm biến siêu âm HC-SR04 và SRF05.

Sử dụng loại cảm biến này, chúng ta có thể cùng nhau chế tạo được các robot hay hệ thống phục vụ cho các mục tiêu cần đo được khoảng cách từ 0 đến 2m. Qua đó, quyết định được thông tin robot cần phải làm gì.

Danh sách linh kiện
Cảm biến siêu âm
Arduino chíp cắm
Dây đực cái

Học lập trình ở đâu

const int trig = 7;//chân trig của HC-SR04
const int echo = 8;//chân echo của HC-SR04
void setup()
{
  Serial.begin(9600);//giao tiếp Serial với baudrate 9600
  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

  /* phát xung từ chân trig */
  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*/
  duration = pulseIn(echo,HIGH);//đo độ rộng xung HIGH ở chân echo. ( http://arduino.vn/reference/pulsein )
  distance = int(duration/2/29.412);//tính khoảng cách đến vật.

  /*in kết quả ra Serial monitor*/
  Serial.print(distance);
  Serial.println("cm");
  delay(200);
}