import utime
import machine
from machine import Pin

ledr = 5
ledb = 4
ledg = 3

trigger = 28
echo = 27

# Initialisierung der GPIO-Pins für die RGB-LED
led_r = machine.Pin(ledr, machine.Pin.OUT)
led_b = machine.Pin(ledb, machine.Pin.OUT)
led_g = machine.Pin(ledg, machine.Pin.OUT)

#Initialiseren Pins Echo
trigger_HC = machine.Pin(trigger, machine.Pin.OUT)
echo_HC = machine.Pin(echo, machine.Pin.IN)

def get_distance():
    # Senden des Trigger-Impulses
    trigger_HC.off()
    utime.sleep_us(2)
    trigger_HC.on()
    utime.sleep_us(5)
    trigger_HC.off()

    # Warte, bis das Echosignal auf LOW wechselt
    pulse_start = machine.time_pulse_us(echo_HC, 1)

    # Berechne die Entfernung in cm
    distance_cm = pulse_start / 58.0

    return distance_cm

def rgb_on():
    led_r.on()
    led_g.on()
    led_b.on()

def rgb_off():
    led_r.off()
    led_g.off()
    led_b.off()

def set_color(red, green, blue):
    led_r.value(red)
    led_g.value(green)
    led_b.value(blue)


# Beispiel: Messt den Abstand und gibt ihn aus
distance = get_distance()
print("Abstand: {} cm".format(distance))

while True:
    distance = get_distance()
    print("Abstand: {} cm".format(distance))
    rgb_on

    if distance <= 10:
        set_color(1, 0, 0)
    elif distance > 10 and distance < 20:
        set_color(1, 0, 1)
    elif distance > 100:
        #set_color(1,1,1)
        #utime.sleep(2)
        rgb_off()
    else: 
        set_color(0, 0, 1)