from  machine  import Pin
import hcsr04
import time

ultrasonic = hcsr04.HCSR04(trigger_pin=4, echo_pin=2, echo_timeout_us=1000000)
led = Pin(23, Pin.OUT)
max_value = 150
  
while True:
  distance = ultrasonic.distance_cm()
  distance_inch = distance*0.39370
  print('Distance ระยะทาง:', distance, 'cm เซนติเมตร', '|', distance/3.99, 'inch นิ้ว')
  if distance >= max_value:
    led.on()
  else:
    led.off()
  time.sleep_ms(500)
  
 
#i2c = I2C(scl=Pin(5), sda=Pin(4), freq=100000)      #Init i2c
lcd=ssd1306.SSD1306_I2C(128,64,i2c) 
 
sensor = HC_SR04(trigger_pin=13, echo_pin=12,echo_timeout_us=1000000)
 
try:
  while True:
    distance = sensor.distance_cm()
    print(distance)
    lcd.fill(0)
    lcd.text("Distance:",30,20) 
    lcd.text(str(distance),30,40)
    lcd.show()
except KeyboardInterrupt:
       pass