from machine import Pin, ADC  # type: ignore
import time
joystickVert = ADC(Pin(28))
joystickHor = ADC(Pin(27))
led1 = Pin(2, Pin.OUT)
led2 = Pin(7, Pin.OUT)
led3 = Pin(6, Pin.OUT)
led4 = Pin(8, Pin.OUT)

def map(valor, valor_min_entrada, valor_max_entrada, valor_min_salida, valor_max_salida):
    return (int)((valor - valor_min_entrada) * (valor_max_salida - valor_min_salida) / (valor_max_entrada - valor_min_entrada) + valor_min_salida)

while True:
    valorHorizontal = joystickHor.read_u16()
    valorVertical = joystickVert.read_u16()

    horizontalmap = map(valorHorizontal, 500, 60000, -1, 1)
    verticalmap = map(valorVertical, 500, 60000, -1, 1)

    if horizontalmap == 1:
        led2.on()
    elif horizontalmap == -1:
        led4.on()
    else:
        led2.off()
        led4.off()

    if verticalmap == 1:
        led3.on()
    elif verticalmap == -1:
        led1.on()
    else:
        led1.off()
        led3.off()

    print(valorHorizontal)
    print(horizontalmap)
    print(valorVertical)
    print(verticalmap)
    
    time.sleep(0.1)