|
|
|
|
|
|
#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); |
|
} |
|
} |