from machine import Pin
import time

# Sensorpinnen definieren
trigger1 = Pin(5, Pin.OUT)
echo1 = Pin(4, Pin.IN)
trigger2 = Pin(7, Pin.OUT)
echo2 = Pin(6, Pin.IN)
trigger3 = Pin(9, Pin.OUT)
echo3 = Pin(8, Pin.IN)
trigger4 = Pin(11, Pin.OUT)
echo4 = Pin(10, Pin.IN)

while True:
    # Sensor 1
    trigger1.value(0)
    time.sleep_us(2)
    trigger1.value(1)
    time.sleep_us(10)
    trigger1.value(0)

    while echo1.value() == 0:
        start1 = time.ticks_us()
    while echo1.value() == 1:
        end1 = time.ticks_us()

    duur1 = time.ticks_diff(end1, start1)
    afstand1 = (duur1 * 0.0343) / 2

    # Sensor 2
    trigger2.value(0)
    time.sleep_us(2)
    trigger2.value(1)
    time.sleep_us(10)
    trigger2.value(0)

    while echo2.value() == 0:
        start2 = time.ticks_us()
    while echo2.value() == 1:
        end2 = time.ticks_us()

    duur2 = time.ticks_diff(end2, start2)
    afstand2 = (duur2 * 0.0343) / 2

    # Sensor 3
    trigger3.value(0)
    time.sleep_us(2)
    trigger3.value(1)
    time.sleep_us(10)
    trigger3.value(0)

    while echo3.value() == 0:
        start3 = time.ticks_us()
    while echo3.value() == 1:
        end3 = time.ticks_us()

    duur3 = time.ticks_diff(end3, start3)
    afstand3 = (duur3 * 0.0343) / 2

    # Sensor 4
    trigger4.value(0)
    time.sleep_us(2)
    trigger4.value(1)
    time.sleep_us(10)
    trigger4.value(0)

    while echo4.value() == 0:
        start4 = time.ticks_us()
    while echo4.value() == 1:
        end4 = time.ticks_us()

    duur4 = time.ticks_diff(end4, start4)
    afstand4 = (duur4 * 0.0343) / 2

    print("Sensor 1 afstand: " + str(int(afstand1)) + " cm")
    print("Sensor 2 afstand: " + str(int(afstand2)) + " cm")
    print("Sensor 3 afstand: " + str(int(afstand3)) + " cm")
    print("Sensor 4 afstand: " + str(int(afstand4)) + " cm")

    time.sleep(1)