วัสดุอปกรณ์

1. ถังขยะ ราคา 37บาท

2. servo ราคา 56บาท

3. สายจัมป์ ราคา64บาท

4. sensor IR ราคา29บาท

รวม186 บาท

CODE โปรแกรม

#include <Servo.h>

#include <NewPing.h>

#define TRIGGER_PIN  A0 // ตั้งค่าขา pin Arduino ต่อกับขา Sensor Triger

#define ECHO_PIN     A1  // ตั้งค่าขา  pin Arduino ต่อกับขา Sensor Echo

#define MAX_DISTANCE 20 // ตั้งค่าระยะการตรวจจับ หน่วยเป็น CM

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);

Servo myservo;

int State = 0;

void setup() {

  Serial.begin(9600);

  myservo.attach(A4);

  myservo.write(160);

  delay(5000);

  myservo.write(0);}

void loop() {

  int Sr = sonar.ping_cm(); // ค่า Sr เท่ากับค่า sonar.ping_cm() คือค่าที่อ่านจาก Sensor Ultrasonic

  Serial.println(State);

  if (State == 0) {

    if (Sr <= 5) {  // ถ้าระยะเซ็นเซอร์น้อยกว่าหรือเท่ากับ 5 ฝาถังปิด

      myservo.write(0);

delay(100);}

    else if (Sr >= 6) { // ถ้าระยะเซ็นเซอร์มากกว่าหรือเท่ากับ 6 ฝาถังเปิด

      myservo.write(160);

      State = 1; }}

  if (State == 1) {

    delay(3000);

    State = 0;}}

ภาพปลากรอบ