from machine import PWM, Pin
import time

servo1 = PWM(Pin(28)) 
servo2 = PWM(Pin(22))  

servo1.freq(50)
servo2.freq(50)

boton_rojo = Pin(15, Pin.IN, Pin.PULL_DOWN)  
boton_azul = Pin(2, Pin.IN, Pin.PULL_DOWN)   

servo1.duty_ns(1500000)
servo2.duty_ns(1500000)

def giro_suave_ida():
    duty1 = 1500000  
    duty2 = 1500000

    for i in range(60):
        duty1 -= int((1500000 - 500000) / 60)
        duty2 += int((2400000 - 1500000) / 60)
        
        servo1.duty_ns(duty1)
        servo2.duty_ns(duty2)
        time.sleep(0.05)

def giro_suave_regreso():
    duty1 = 500000  
    duty2 = 2400000  

    for i in range(60):
        duty1 += int((1500000 - 500000) / 60)
        duty2 -= int((2400000 - 1500000) / 60)
        
        servo1.duty_ns(duty1)
        servo2.duty_ns(duty2)
        time.sleep(0.05)

while True:
    if boton_rojo.value() == 1:
        giro_suave_ida()
        while boton_rojo.value() == 1:
            time.sleep(0.01)
    
    if boton_azul.value() == 1:
        giro_suave_regreso()
        while boton_azul.value() == 1:
            time.sleep(0.01)