เครื่องวัดระยะอัลตราโซนิกด้วย ESP32 และ HC-SR04
เซ็นเซอร์อัลตราโซนิก HC-SR04 คำนวณระยะจากเวลาที่คลื่นเสียงเดินทางไปกระทบวัตถุแล้วสะท้อนกลับ โปรเจกต์นี้ใช้ ESP32 ส่งพัลส์ยาว 10 ไมโครวินาทีไปที่ขา TRIG และอ่านเวลาของเสียงสะท้อนจากขา ECHO ด้วย pulseIn() จากนั้นแสดงระยะเป็น cm บนจอ LCD I2C ขนาด 16x2 เนื่องจาก HC-SR04 ใช้ไฟ 5 V จึงต้องต่อวงจรแบ่งแรงดันที่ขา ECHO มิฉะนั้นขา GPIO แบบ 3.3 V ของ ESP32 จะเสียหาย

วิดีโอ
แผนผังวงจร

ซอร์สโค้ด
1// ─────────────────────────────────────────
2// BlueGrays · bluegrays.com
3// ESP32 HC-SR04 Ultrasonic Distance Sensor
4// ─────────────────────────────────────────
5// Triggers the HC-SR04 with a TRIG pulse, computes the distance (cm) from
6// the ECHO time and shows it on a 16x2 I2C LCD every 0.2 s. If no echo
7// comes back, the screen shows "Menzil disinda" (out of range).
8//
9// Pins:
10// GPIO 5 -> HC-SR04 TRIG
11// GPIO 18 -> HC-SR04 ECHO (via a voltage divider)
12// Divider: ECHO -> 1k -> GPIO 18 -> 2k -> GND
13// GPIO 21 -> LCD SDA, GPIO 22 -> LCD SCL
14// HC-SR04 and LCD VCC -> 5V (VIN), GND -> GND
15
16#include <Wire.h>
17#include <LiquidCrystal_I2C.h>
18
19// Pin definitions
20const int TRIG_PIN = 5;
21const int ECHO_PIN = 18; // Needs a 1k + 2k voltage divider
22
23// LCD addr 0x27 or 0x3F
24LiquidCrystal_I2C lcd(0x27, 16, 2);
25
26const float SOUND_SPEED_CM_PER_US = 0.0343f; // Speed of sound (cm/us)
27const unsigned long PULSE_TIMEOUT_US = 30000UL; // Echo timeout (~5 m)
28
29void setup() {
30 pinMode(TRIG_PIN, OUTPUT);
31 pinMode(ECHO_PIN, INPUT);
32 digitalWrite(TRIG_PIN, LOW);
33
34 // DevKit V1 default I2C pins
35 Wire.begin(21, 22);
36
37 lcd.init();
38 lcd.backlight();
39
40 // Splash screen 3 s
41 lcd.setCursor(3, 0);
42 lcd.print("BlueGrays");
43 lcd.setCursor(1, 1);
44 lcd.print("HC-SR04 v1.0");
45 delay(3000);
46
47 // Main screen
48 lcd.clear();
49 lcd.setCursor(0, 0);
50 lcd.print("Distance:");
51}
52
53// Reads the distance in cm, -1 on error
54float readDistanceCm() {
55 // A 10 us TRIG pulse starts a measurement
56 digitalWrite(TRIG_PIN, LOW);
57 delayMicroseconds(2);
58 digitalWrite(TRIG_PIN, HIGH);
59 delayMicroseconds(10);
60 digitalWrite(TRIG_PIN, LOW);
61
62 unsigned long duration = pulseIn(ECHO_PIN, HIGH, PULSE_TIMEOUT_US);
63 if (duration == 0) return -1.0f;
64 // Round trip, so divide by 2
65 return (duration * SOUND_SPEED_CM_PER_US) / 2.0f;
66}
67
68void loop() {
69 float distance = readDistanceCm();
70
71 // Clear bottom row
72 lcd.setCursor(0, 1);
73 lcd.print(" ");
74 lcd.setCursor(0, 1);
75
76 if (distance < 0) {
77 lcd.print("Out of range");
78 } else {
79 lcd.print(distance, 1); // 1 decimal place
80 lcd.print(" cm");
81 }
82
83 delay(200);
84}
85
FAQ
ทำไมต้องต่อวงจรแบ่งแรงดันที่สาย ECHO
HC-SR04 ใช้ไฟ 5 V และขา ECHO ให้เอาต์พุต 5 V แต่อินพุตของ ESP32 รับได้สูงสุด 3.3 V วงจรแบ่งแรงดันที่ใช้ตัวต้านทาน 1 kΩ และ 2 kΩ จะลดแรงดันจาก 5 V เหลือประมาณ 3.3 V เพื่อป้องกัน ESP32
ขา TRIG ต้องใช้วงจรแบ่งแรงดันด้วยไหม
ไม่จำเป็น TRIG เป็นสัญญาณที่ส่งจาก ESP32 ไปยังเซ็นเซอร์ โดยทั่วไป HC-SR04 ตรวจจับสัญญาณ HIGH ระดับ 3.3 V จาก ESP32 ได้อย่างเชื่อถือได้
ถ้าใช้ HC-SR04P ยังต้องใช้วงจรแบ่งแรงดันไหม
รุ่นอย่าง HC-SR04P และ RCWL-1601 ใช้ไฟเลี้ยง 3.3 V ได้ ในกรณีนี้เอาต์พุต ECHO ก็จะเป็น 3.3 V จึงไม่ต้องใช้วงจรแบ่งแรงดัน
ทำอย่างไรให้วัดระยะได้แม่นยำขึ้น
ความเร็วเสียงเปลี่ยนตามอุณหภูมิ (ประมาณ 343 m/s ที่ 20 °C) การใช้เซ็นเซอร์อุณหภูมิช่วยปรับค่าความเร็วเสียงและใช้ค่ามัธยฐานจากการวัดหลายครั้งจะช่วยเพิ่มความแม่นยำ
