#include <Servo.h>

Servo servo1;  // Crea objetos servo para cada servomotor
Servo servo2;
Servo servo3;

void setup() {
  servo1.attach(9);  // Asigna los pines a los servomotores
  servo2.attach(10);
  servo3.attach(11);

  // Inicializa el puerto serial para depuración
  Serial.begin(9600);
}

void loop() {
  // Ejemplo: Establece ángulos iniciales para los tres servos
  moverServos(0, 90, 180);
  delay(2000); // Espera dos segundos

  // Cambia los ángulos de los servos
  moverServos(90, 180, 0);
  delay(2000); // Espera dos segundos

  // Añade más secuencias de movimiento según sea necesario
}

// Función para mover los tres servos a los ángulos especificados
void moverServos(int angulo1, int angulo2, int angulo3) {
  servo1.write(angulo1);  // Mueve el servo 1 al ángulo especificado
  servo2.write(angulo2);  // Mueve el servo 2 al ángulo especificado
  servo3.write(angulo3);  // Mueve el servo 3 al ángulo especificado

  // Opcional: Imprime los ángulos actuales para depuración
  Serial.print("Servo 1: ");
  Serial.print(angulo1);
  Serial.print("°, Servo 2: ");
  Serial.print(angulo2);
  Serial.print("°, Servo 3: ");
  Serial.print(angulo3);
  Serial.println("°");
}