from machine import Pin, ADC, PWM
from utime import sleep

# Crear objetos
sensor = ADC(Pin(35))
ledA = Pin(22, Pin.OUT)  # Definir correctamente el LED
sensor2 = ADC(Pin(13))
ledR = Pin(18, Pin.OUT)
motor= PWM(Pin(21), freq=50) 
motor2= PWM(Pin(19), freq=50) 

# Regular precisión de lectura
sensor.width(ADC.WIDTH_10BIT)  # 2^10 = 0 - 1023
sensor2.width(ADC.WIDTH_10BIT)
# Ajustar la atenuación
sensor.atten(ADC.ATTN_11DB)
sensor2.atten(ADC.ATTN_11DB)

# Lógica
def ruta(x):
    return int((x-0)*(125-5)/(180-0)+25) # Formula conversion Duty(m)
    
while True:
    lectura = int(sensor.read())
    lectura2 = int(sensor2.read())
    print(lectura, "Azul") 
    sleep(0.5)
    print(lectura2,"Rojo")
    sleep(0.5)
    for i in range(0,180):
        m=ruta(i)
        motor.duty(m)
        if lectura >= 100 and m==90:
            ledA.on()
            sleep(0.5)
        elif m!=90:
            ledA.off()
            sleep(0.5)
        print(m)
        sleep(0.1)
        motor2.duty(m)
        if lectura2 <= 100 and m==0:
            ledR.on()
            sleep(0.5)
        elif m!=0:
            ledR.off()
            sleep(0.5)
        elif lectura2 <= 100 and m==180:
            ledR.on()
            sleep(0.5)
        elif m!=180:
            ledR.off()
            sleep(0.5)
        sleep(0.1)