#include <Servo.h> // Thư viện servo

Servo myservo; // Khai báo servo

void setup() 
{
  Serial.begin(9600);
  myservo.attach(9); // Gán chân điều khiển servo cho chân 9
  myservo.write(0); // Đặt servo về vị trí ban đầu (0 độ)
  pinMode(2,INPUT);
  pinMode(3,INPUT);
  pinMode(4,INPUT);
}
void manunal()
{
  for (int i = 0; i <= 180; i++) { // Lặp từ 0 đến 180
    myservo.write(i); // Đặt servo đến vị trí i độ
    delay(20); // Chờ 20 mili giây
  }
  for (int i = 180; i >= 0; i--) { // Lặp từ 180 đến 0
    myservo.write(i);
    delay(20);
  }
}
void loop()
{
int trangthaimanunal=digitalRead(2);
int trangthaiauto=digitalRead(3);
Serial.println(trangthaimanunal);
if (trangthaimanunal==1)
{ 
  Serial.println("che do tay");
  manunal();
}
if (trangthaiauto==1)
{
   Serial.println("che do auto");
  for(int i = 0; i <= 999; i++)
  {
    manunal();
    if ((digitalRead(2))==1)    i=1000;
  }

}
}