#include <Servo.h>

// Definir el pin al que está conectado el servo
#define SERVO_PIN 6

// Crear un objeto de tipo Servo
Servo servoMotor;

void setup() {
  // Inicializar el servo
  servoMotor.attach(SERVO_PIN);
  
  // Iniciar comunicación serial a 9600 baudios
  Serial.begin(9600);
}

void loop() {
  // Girar el servo hacia la posición 0 grados
  servoMotor.write(0);
  delay(3000); // Esperar 1 segundo
  imprimirAnguloActual();

  // Girar el servo hacia la posición 90 grados
  servoMotor.write(90);
  delay(3000); // Esperar 1 segundo
  imprimirAnguloActual();

  // Girar el servo hacia la posición 180 grados
  servoMotor.write(180);
  delay(3000); // Esperar 1 segundo
  imprimirAnguloActual();
}

void imprimirAnguloActual() {
  // Leer el ángulo actual del servo
  int angulo = servoMotor.read();
  
  // Imprimir el ángulo en el monitor serial
  Serial.print("Angulo actual del servo: ");
  Serial.println(angulo);
}