from machine import Pin, PWM
import time

#Inicializar PWM en el pin 15 para
#control del servo
servo = PWM(machine.Pin(15))

#Declara los pulsadores como entradas
rojo=Pin(12, Pin.IN)
azul=Pin(6, Pin.IN)

#Ajusta la frecuencia PWM
servo.freq (50)

#Función para calcular el DC para cualquier ángulo:
def calcularDC(angulo):
    return (angulo*6062)//(180) + 1802

#Posiciona el servo en 90°
angulo=90
servo.duty_u16(calcularDC(angulo)) 

while True:
    #Lee el estado del pin 12 (botón Rojo)
    if rojo.value()==1:
        if angulo>=0:
            angulo+=5
            servo.duty_u16(calcularDC(angulo))
            time.sleep(0.01)
        else:
            angulo=0
    #Lee el estado del pin 6 (botón Azul)
    if azul.value()==1:
        if angulo<=180:
            angulo-=5
            servo.duty_u16(calcularDC(angulo))
            time.sleep(0.01)
        else:
            angulo=180
    time.sleep(0.01)