from machine import Pin, SoftI2C, Timer
from hcsr04 import HCSR04
import ssd1306
import time

sonar = HCSR04(trigger_pin=12, echo_pin=14)
i2c = SoftI2C(scl=Pin(22), sda=Pin(21))
oled = ssd1306.SSD1306_I2C(128, 64, i2c)

def display(self):
    oled.fill(0) #清除畫面
    distance = sonar.distance_cm()
    oled.text("Distance", 0, 0)
    oled.text(str(distance)+ " cm", 0, 20)    
    oled.show()
    
timer1=Timer(1)
timer1.init(period=1000, mode=Timer.PERIODIC, callback=display) # 每隔1秒執行