from machine import Pin,time_pulse_us
import time

trig=Pin(1,Pin.OUT)
echo=Pin(2,Pin.IN)

rled=Pin(15,Pin.OUT)
gled=Pin(14,Pin.OUT)

buzz=Pin(16,Pin.OUT)

def distance():
    trig.low()
    time.sleep_us(2)
    trig.high()
    time.sleep_us(10)
    trig.low()
    
    dur=time_pulse_us(echo,1,30000)
    dist=(dur*0.0343)/2
    return dist
while True:
    d=distance()
    print("Distance:",d)
    if d<7:
        gled.value(0)
        rled.value(1)
        buzz.value(1)
        print("Too close")
        time.sleep_us(5)
    else:
        rled.value(0)
        gled.value(1)