| |
| |
|
| |
|
| |
#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; |
| |
|
| |
void setup() { |
| |
Serial.begin(9600); |
| |
myservo.attach(A4); //ตั้งค่าขา A4 เป็น pin Servo |
| |
myservo.write(0); |
| |
} |
| |
void loop() { |
| |
int Sr = sonar.ping_cm(); // ค่า Sr เท่ากับค่า sonar.ping_cm() คือค่าที่อ่านจาก Sensor Ultrasonic |
| |
Serial.println(Sr); |
| |
if (Sr > 0 && Sr <= 15) { |
| |
myservo.write(160); |
| |
delay(5000); //หน่วงเวลาเปิดฝาถังขยะ |
| |
} else { |
| |
myservo.write(0); |
| |
delay(100); |
| |
} |
| |
} |