#include <ESP32Servo.h>

const int servoPin1 = 18;
const int buttonPin1 = 2; // Pin cho nút nhấn 1
const int servoPin2 = 15;
const int buttonPin2 = 4; // Pin cho nút nhấn 2
const int buttonPin3 = 5; // Pin cho nút nhấn 3

int buttonState1 = 0;
int buttonState2 = 0;
int buttonState3 = 0;

bool button1Pressed = false;
bool button2Pressed = false;
bool button3Pressed = false;

Servo myServo1;
Servo myServo2;

void setup() {
  pinMode(buttonPin1, INPUT);
  pinMode(buttonPin2, INPUT);
  pinMode(buttonPin3, INPUT);
  
  myServo1.attach(servoPin1);
  myServo2.attach(servoPin2);
}

void loop() {
  buttonState1 = digitalRead(buttonPin1);
  buttonState2 = digitalRead(buttonPin2);
  buttonState3 = digitalRead(buttonPin3);

  // Xử lý nút nhấn 1
  if (buttonState1 == HIGH && !button1Pressed) {
    myServo1.write(90);
    button1Pressed = true;
  } else if (buttonState1 == HIGH && button1Pressed) {
    myServo1.write(0);
    button1Pressed = false;
  }

  // Xử lý nút nhấn 2
  if (buttonState2 == HIGH && !button2Pressed) {
    myServo2.write(90);
    button2Pressed = true;
  } else if (buttonState2 == HIGH && button2Pressed) {
    myServo2.write(0);
    button2Pressed = false;
  }

  // Xử lý nút nhấn 3
  if (buttonState3 == HIGH && !button3Pressed) {
    myServo1.write(90);
    myServo2.write(90);
    button3Pressed = true;
  } else if (buttonState3 == HIGH && button3Pressed) {
    myServo1.write(0);
    myServo2.write(0);
    button3Pressed = false;
  }

  delay (50);
}