ระดับกลาง

สร้างจอแสดงผลเรดาร์อัลตราโซนิก

กวาดเซนเซอร์อัลตราโซนิกไปตามส่วนโค้งกว้างๆ ด้วยเซอร์โว แล้วดูจอแสดงผลแบบเรดาร์กวาดแบบเรียลไทม์ที่สร้างขึ้นบนหน้าจอ ซึ่งเป็นเส้นกวาดสีเขียวแบบคลาสสิก ทำจากชิ้นส่วนที่ทำงานนี้ได้อย่างแม่เจาะจงอยู่แล้ว

แผนภาพการต่อสาย

โค้ดเริ่มต้น

#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include <ESP32Servo.h>

// --- Pin definitions: adjust to match your ESP32-S3 board's silkscreen if different ---
#define TRIG_PIN   4   // HC-SR04 trigger (output)
#define ECHO_PIN   5   // HC-SR04 echo (input, through a 1k/2k voltage divider - ECHO is 5V logic)
#define SERVO_PIN  6   // SG90 signal (PWM-capable pin)
#define OLED_SDA   8   // ESP32-S3 default I2C SDA
#define OLED_SCL   9   // ESP32-S3 default I2C SCL

#define SCREEN_WIDTH  128
#define SCREEN_HEIGHT 64
#define OLED_ADDR     0x3C

Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, -1);
Servo radarServo;

const int MAX_DISTANCE_CM = 40;   // radar range shown on screen
const int CENTER_X = 64;
const int CENTER_Y = 63;
const int RADIUS_PX = 60;

long readDistanceCM() {
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);

  long duration = pulseIn(ECHO_PIN, HIGH, 25000); // 25ms timeout (~4m max)
  if (duration == 0) return -1; // no echo / out of range
  return duration * 0.0343 / 2;
}

void setup() {
  Serial.begin(115200);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);

  radarServo.attach(SERVO_PIN);

  Wire.begin(OLED_SDA, OLED_SCL);
  if (!display.begin(SSD1306_SWITCHCAPVCC, OLED_ADDR)) {
    Serial.println("OLED init failed");
    while (true) delay(1000);
  }
  display.clearDisplay();
  display.display();
}

void sweepAndDraw(int angle) {
  radarServo.write(angle);
  delay(150); // let the servo settle before reading

  long distance = readDistanceCM();

  display.clearDisplay();

  // Sweep line from center at current angle
  float rad = radians(angle);
  int lineLen = RADIUS_PX;
  if (distance > 0 && distance < MAX_DISTANCE_CM) {
    lineLen = map(distance, 0, MAX_DISTANCE_CM, 0, RADIUS_PX);
  }
  int x = CENTER_X - cos(rad) * lineLen;
  int y = CENTER_Y - sin(rad) * lineLen;
  display.drawLine(CENTER_X, CENTER_Y, x, y, SSD1306_WHITE);

  // Text readout
  display.setTextSize(1);
  display.setTextColor(SSD1306_WHITE);
  display.setCursor(0, 0);
  display.print("Angle: ");
  display.print(angle);
  display.print((char)247); // degree symbol
  display.setCursor(0, 10);
  display.print("Dist: ");
  if (distance > 0) {
    display.print(distance);
    display.print(" cm");
  } else {
    display.print("--");
  }
  display.display();
}

void loop() {
  for (int angle = 0; angle <= 180; angle += 3) {
    sweepAndDraw(angle);
  }
  for (int angle = 180; angle >= 0; angle -= 3) {
    sweepAndDraw(angle);
  }
}

ไม่แน่ใจขั้นตอนไหน? ถามเรา

ลองทำโปรเจกต์นี้ต่อ

สร้างเครื่องวัดอุณหภูมิและความชื้นในห้อง สร้างไฟส่องโต๊ะทำงานแบบตรวจจับการเคลื่อนไหว สร้างเครื่องบันทึกข้อมูลสภาพแวดล้อมแบบไร้สาย