ES-14ปานกลาง

เครื่องวัดระยะอัลตราโซนิกด้วย ESP32 และ HC-SR04

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

4.9(29)
48 เสร็จแล้ว
เครื่องวัดระยะอัลตราโซนิกด้วย ESP32 และ HC-SR04
อุปกรณ์เล็กๆ ที่วัดว่ามือหรือกล่องอยู่ห่างแค่ไหนโดยไม่ต้องใช้ไม้บรรทัด เซ็นเซอร์วัดระยะส่งเสียงที่หูคนไม่ได้ยินแล้วรอฟังเสียงสะท้อน จากนั้น ESP32 แสดงผลเป็นเซนติเมตรบนจอเล็กๆ และแจ้งเมื่อวัตถุอยู่นอกระยะวัด คุณจะได้เห็นหลักการที่ค้างคาวใช้หาทางในความมืดบนโต๊ะของตัวเอง

วิดีโอ

แผนผังวงจร

เครื่องวัดระยะอัลตราโซนิกด้วย ESP32 และ HC-SR04 - แผนผังวงจร

ซอร์สโค้ด

C++ (Arduino IDE)
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) การใช้เซ็นเซอร์อุณหภูมิช่วยปรับค่าความเร็วเสียงและใช้ค่ามัธยฐานจากการวัดหลายครั้งจะช่วยเพิ่มความแม่นยำ