#PARCIAL 2 DIGITAL II
from machine import Pin, PWM, ADC
from time import sleep


joyY= ADC(Pin(34)) #Naranja
joyY.atten(ADC.ATTN_11DB)
joyX= ADC(Pin(35)) #Café
joyX.atten(ADC.ATTN_11DB)
servo= PWM(Pin(14), freq=50, duty= 0) #Rosa
ledRojo= Pin(18, Pin.OUT)
ledVerde= Pin(21, Pin.OUT)
ledAzul= Pin(19, Pin.OUT)

def angle_servo(angle):
    maximo= 126
    minimo=26
    dutyC=int(minimo+(angle/180)*(maximo-minimo))
    servo.duty(dutyC)

def angle_joystick():
    valorX= joyX.read()
    return(valorX/4095)* 180

while True:
    valory= joyY.read()
    print(valory)
    valorX= joyX.read()
    print(valorX)
    if valory == 2048:
        ledAzul.on()
        ledVerde.off()
        ledRojo.off()
        sleep(0.2)
    elif valory< 2048:
        ledVerde.off()
        ledAzul.off()
        ledRojo.on()
        sleep(0.2)
    else:
        ledRojo.off()
        ledAzul.off()
        ledVerde.on()
        sleep(0.2)

    if valorX > 2048:
        angle_servo(180)
    elif valorX < 2048:
        angle_servo(0)
    else: angle_servo(90)