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);
}
