from machine import Pin 
from hcsr04 import HCSR04
from machine import Pin, PWM
from machine import Pin, PWM
from time import sleep

#______________________________________________________
medidor1 = HCSR04(trigger_pin = 4, echo_pin = 5)
medidor2 = HCSR04(trigger_pin = 15, echo_pin =2)
medidor3 = HCSR04(trigger_pin = 21, echo_pin = 19)
Zumbador1 = PWM(Pin(22), freq =(1), duty =512)
Zumbador2 = PWM(Pin(18), freq =(1), duty =512)
Zumbador3 = PWM(Pin(23), freq =(1), duty =512)

#______________________________________________________
def freq (freq):
    Zumbador1.freq(freq)
    Zumbador1.duty(512)

    Zumbador2.freq(freq)
    Zumbador2.duty(512)

    Zumbador3.freq(freq)
    Zumbador3.duty(512)

#______________________________________________________
while (True):
    distancia1 = round(medidor1.distance_cm(), 2)
    distancia2 = round(medidor2.distance_cm(), 2)
    distancia3 = round(medidor3.distance_cm(), 2)

#___________________________
    if distancia1 >= 10:
        print("cercano 1")
        Zumbador1.freq(900)

    if distancia1 >= 80:
        print ("mediano 1")
        Zumbador1.freq (700)

    if distancia1 >= 130:
        print ("lejos 1")
        Zumbador1.freq (400)


    if distancia1 >= 200:
        print ("muy lejos 1")
        Zumbador1.freq (200)


    if distancia2 >= 10:
        print("cercano 2")
        Zumbador2.freq(900)

    if distancia2 >= 80:
        print ("mediano 2")
        Zumbador2.freq (700)

    if distancia2 >= 130:
        print ("lejos 2")
        Zumbador2.freq (400)


    if distancia2 >= 200:
        print ("muy lejos 2")
        Zumbador2.freq (200)


    if distancia3 >= 10:
        print("cercano 3")
        Zumbador3.freq(900)

    if distancia3 >= 80:
        print ("mmediano 3")
        Zumbador3.freq (700)

    if distancia3 >= 130:
        print ("lejos 3")
        Zumbador3.freq (400)


    if distancia3 >= 200:
        print ("muy lejos 3")
        Zumbador3.freq (200)
    
    else:
        Zumbador1.freq (1)
        Zumbador2.freq (1)
        Zumbador3.freq (1)
        print("nada")