from hcsr04 import HCSR04
from machine import Pin, PWM
from machine import Pin, I2C
import ssd1306
import time 

ultrasonic = HCSR04(trigger_pin = 13, echo_pin =12)
from time import sleep
buzzer = Pin (16, Pin.OUT)
buzzer = PWM(Pin(16))

i2c = I2C (0, scl=Pin(22), sda=Pin(21))

oled_width = 128
oled_height = 64
oled = ssd1306.SSD1306_I2C (oled_width, oled_height, i2c)

led = Pin (2, Pin.OUT) 

while True:
    jarak = ultrasonic.distance_cm()
    print('Jarak' , jarak, "CM")
    sleep(0.1)

    if (jarak < 125):
        frequency = 1000
        buzzer.freq(frequency)
        sleep(0.5)
        buzzer.duty(512)
        sleep(0.5)
    else:
        buzzer.duty(0)

    if (jarak < 125):
        frequency = 500
        buzzer.freq(frequency)
        sleep(0.5)
        buzzer.duty(512)
        sleep(0.5)
    else:
        buzzer.duty(0)

def display_message(message):
    oled.fill(0)
    oled.text(message, 0, 0)
    oled.show()