ระบบวัดระยะทางด้วย Ultrasonic HC-SR04 แล้วส่งสัญญาณเตือนด้วย LED และ Buzzer

double fnc_ultrasonic_distance(int _t, int _e){ //ฟังก์ชันในการคำนวณระยะทาง
unsigned long dur=0;
digitalWrite(_t, LOW);
delayMicroseconds(5);
digitalWrite(_t, HIGH);
delayMicroseconds(10);
digitalWrite(_t, LOW);
dur = pulseIn(_e, HIGH, 18000);
if(dur==0)return 999.0;
return (dur/57);
}
void setup()
{
pinMode(2, OUTPUT);
pinMode(3, INPUT);
pinMode(12, OUTPUT);
pinMode(13, OUTPUT);
Serial.begin(9600);
Serial.flush();
while(Serial.available()>0)Serial.read();
}
void loop()
{
if ((fnc_ultrasonic_distance(2,3) < 30)) {
digitalWrite(12, HIGH);
digitalWrite(13, HIGH);
delay(300);
digitalWrite(12, LOW);
digitalWrite(13, LOW);
delay(300);
}
Serial.println(fnc_ultrasonic_distance(2,3));
delay(500);
}