const int trig = 26; //กำหนดตัวแปร trig แทนขา 26
const int echo = 27; //กำหนดตัวแปร echo แทนขา 27
int dura_uS; //สร้างตัวแปร dura_uS เก็บระยะห่างหน่วยไมโครวินาที
int dis_cm; //สร้างตัวแปร dis_cm เก็บระยะทางที่แปลงหน่วยเซนติเมตร
void setup() {
Serial.begin (115200);
pinMode(trig, OUTPUT);
pinMode(echo, INPUT);
}
void loop() {
digitalWrite(trig, HIGH); //ให้ขา Trig สร้างสัญญาณ pulse
delayMicroseconds(10); //รอ 10/1,000,000 sec
digitalWrite(trig, LOW);
dura_uS = pulseIn(echo, HIGH); //วัดระยะเวลาของ pulse จากขา echo
dis_cm = dura_uS/58; //แปลงความเร็วเสียงในอากาศเป็นระยะทาง
Serial.print("ระยะทาง: ");
Serial.print(dis_cm); // ระยะทางที่วัดได้จะอยู่ในช่วง 2-400 cm
Serial.println(" cm");
delay(500);
}