import network
from machine import Pin, SoftI2C
import utime
from hcsr04 import HCSR04

trigger = Pin(3, Pin.OUT)
echo = Pin(2, Pin.IN)
sensor = HCSR04(trigger_pin=3, echo_pin=2, echo_timeout_us=1000000)


print("Connecting to WiFi", end="")
sta_if = network.WLAN(network.STA_IF)
sta_if.active(True)
sta_if.connect('Wokwi-GUEST', '')
while not sta_if.isconnected():
  print(".", end="")
  utime.sleep(0.1)
print(" Connected!")
while True:
  try:
    distance = sensor.distance_mm()
    print('Distance:', distance, 'mm')
  except OSError as ex:
    print('ERROR getting distance:', ex)
  utime.sleep(1)