from machine import Pin
import utime

trigger = Pin(2, Pin.OUT)
echo = Pin(3, Pin.IN)
ledy = Pin(20, Pin.OUT)
ledg = Pin(18, Pin.OUT)
ledr = Pin(17, Pin.OUT)

def ultra():
   trigger.low()
   utime.sleep_us(2)
   trigger.high()
   utime.sleep_us(5)
   trigger.low()
   while echo.value() == 0:
       signaloff = utime.ticks_us()
   while echo.value() == 1:
       signalon = utime.ticks_us()
   timepassed = signalon - signaloff
   d = (timepassed * 0.0343) / 2 /100
   print("The distance from object is ",d,"Meters")


   if d > 1.01:
    print ("INCORRECT: Beyond")
    ledr.on()
    ledg.off()
    ledy.off()

   if d < .99:
    print ("INCORRECT: Away") 
    ledr.off()
    ledg.off()
    ledy.on()

   if (d < 1.01 and d > .99):
    print("CORRECT")
    ledr.off()
    ledg.on()
    ledy.off()

while True:
   ultra()
   utime.sleep(.1)