#include <stdio.h>
#include "pico/stdlib.h"
#include "servo.h"

int main()
{
  stdio_init_all();  // Inicializa comunicação serial
  servo_init();      // Configura servos

  printf("Iniciando o sistema de servos...\n");

  // Executa o ciclo de movimentos
  servo1_movimento();
  servo2_movimento();
  printf("Movimento concluído.\n");

  while (true)
  {
    sleep_ms(500);
  }

  return 0;
}