#include <Servo.h>
#define TRIGGER_PIN  A0 // ตั้งค่าขา pin Arduino ต่อกับขา Sensor Triger
#define ECHO_PIN     A1  // ตั้งค่าขา  pin Arduino ต่อกับขา Sensor Echo
#define MAX_DISTANCE 20 // ตั้งค่าระยะการตรวจจับ หน่วยเป็น CM
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;
  }
}