from machine import Pin, ADC
from hcsr04 import HCSR04
import time
import utime
from time import sleep
#-----------------------------------------------------------------------------------------------
#Funcion y objetos
def main():
    medidor = HCSR04(trigger_pin = 4, echo_pin = 5)
    llanta_1 = Pin(22, Pin.OUT)
    llanta_2 = Pin(21, Pin.OUT)

#-----------------------------------------------------------------------------------------------
    #CONSTANTES
#-----------------------------------------------------------------------------------------------
#Acciones
    while True:
        distancia = medidor.distance_cm()
        conver3= distancia
        print(" Distance =", conver3,"cm")
        time.sleep(0.5)
        if conver3 >=5 and conver3 <=40:
            llanta_1.value(1)
            llanta_2.value(1)
        if conver3 >=41 and conver3 <=400:
            llanta_1.value(0)
            llanta_2.value(1)           




#-------------------------------------------------------------------------
         
if __name__ == '__main__':
    main()