from picozero import RGBLED
from time import sleep

import time
time.sleep(0.1)  # Wait for USB to become ready
from picozero import RGBLED
from machine import Pin, time_pulse_us
from time import sleep
from picozero import Buzzer

# Initialize RGB LED
rgb = RGBLED(red=0, green=15, blue=14)

# Initialize ultrasonic sensor pins
TRIGGER_PIN = 3
ECHO_PIN = 28
trigger = Pin(TRIGGER_PIN, Pin.OUT)
echo = Pin(ECHO_PIN, Pin.IN)

# Number of readings to take
num_readings = 50
buzzer = Buzzer(22)


def get_distance_cm():
    trigger.low()
    time.sleep_us(2)
    trigger.high()
    time.sleep_us(10)
    trigger.low()
    
    pulse_time = time_pulse_us(echo, 1, 30000)
    distance_cm = pulse_time / 58 if pulse_time > 0 else 0
    
    return distance_cm

for _ in range(num_readings):
    distance_cm = get_distance_cm()
    
    if distance_cm <= 100:
        rgb.color=(255, 0, 0)  # Red
        status = "Low Red"
        buzzer.beep()
        sleep(1)
    elif distance_cm <= 200:
        rgb.color=(0, 255, 0)  # Green
        status = "Medium Green"
    else:
        rgb.color=(0, 0, 255)  # Blue
        status = "High Blue"
    
    print(f"Distance: {distance_cm:.2f} cm - {status}")
    sleep(1)

#buzzer ON
#buzzer beep FAST if CLOSE 🤔
#buzzer do SLOW if FAR 😳