#include <Servo.h>

// Assegna i pin per i servomotori e il pulsante
#define SERVO_1_PIN 9
#define SERVO_2_PIN 10
#define BUTTON_PIN 2

// Inizializza i servomotori e il pulsante
Servo servo1;
Servo servo2;
int buttonState = 0;
int lastButtonState = 0;

void setup() {
  // Assegna i pin ai servomotori
  servo1.attach(SERVO_1_PIN);
  servo2.attach(SERVO_2_PIN);
  
  // Assegna il pin al pulsante
  pinMode(BUTTON_PIN, INPUT_PULLUP);
}

void loop() {
  // Leggi lo stato del pulsante
  buttonState = digitalRead(BUTTON_PIN);

  // Se il pulsante viene premuto
  if (buttonState == LOW && lastButtonState == HIGH) {
    // Inverti lo stato dei servomotori
    if (servo1.read() == 30 && servo2.read() == 150) {
      servo1.write(150);
      servo2.write(30);
    } else {
      servo1.write(30);
      servo2.write(150);
    }
  }

  // Salva lo stato attuale del pulsante
  lastButtonState = buttonState;

  // Aggiorna i servomotori
  delay(15);
}