code cảm biến siêu âm SRF 05 cho Arduino

 code cảm biến siêu âm SRF 05 cho Arduino

const int TRIGER = 7;//chân TRIGER
const int ECHO= 8;//chân ECHO

void setup()
{
  Serial.begin(9600);//giao tiếp Serial với baudrate 9600
  pinMode(TRIGER,OUTPUT);//khai báochân trig sẽ xuất tín hiệu
  pinMode(ECHO,INPUT);//khai báo chân echo sẽ nhận tín hiệu
}

void loop()
{
  unsigned long pulse_length ;//biến đo thời gian mức cao chân echo
  int distance;//biến lưu khoảng cách
  /* phát xung 10 us từ chân trig */
  digitalWrite(TRIGER,HIGH);//đưa chân triger lên mưc cao
  delayMicroseconds(10);
  digitalWrite(ECHO,LOW);// đưa chân triger xuống mức thấp


  /*tính toán thời gian*/
  pulse_length  = pulseIn(ECHO,HIGH);//đo độ rộng xung HIGH ở chân echo
  distance = int(pulse_length/58);//tính khoảng cách đến vật theo cm
  /*in kết quả */
  Serial.print(distance);
  Serial.println("cm");
  delay(300);
}