# Fernsteurung RoboCar 
from machine import Pin
import time
links1 = Pin(33, Pin.IN, Pin.PULL_UP)  #  erhöht 'gang' um 1
links2 = Pin(25, Pin.IN, Pin.PULL_UP)  #  setzt 'gang' auf 0
links3 = Pin(26, Pin.IN, Pin.PULL_UP)  #  vermindert 'gang' um 1

rechts1 = Pin(27, Pin.IN, Pin.PULL_UP)  #  kurve links
rechts2 = Pin(14, Pin.IN, Pin.PULL_UP)  #  gerade
rechts3 = Pin(12, Pin.IN, Pin.PULL_UP)  #  kruve rechts

pressed = False
gang = 0; gang_max = 5; gang_min = -3
while True:
    print(links1.value(), links2.value(),  links3.value())
    time.sleep(0.5)
    
    if links1.value()==pressed and links2.value()==pressed and links3.value()==pressed:
        pass
    elif links1.value()==pressed and links2.value()==pressed:
        pass
    elif links1.value()==pressed and links3.value()==pressed:
        pass
    elif links2.value()==pressed and links3.value()==pressed:
        pass
    elif links1.value()==pressed:
        gang -= 1
        if gang < gang_min:
            gang = gang_min
    elif links2.value()==pressed:
        gang = 0
    elif links3.value()==pressed:
        gang += 1
        if gang > gang_max:
            gang = gang_max
    print(gang)

    if rechts1.value()==pressed and rechts2.value()==pressed and rechts3.value()==pressed:
        pass
    elif recht1.value()==pressed and rechts2.value()==pressed:
        pass
    elif rechts1.value()==pressed and rechts3.value()==pressed:
        pass
    elif recht2.value()==pressed and rechts3.value()==pressed:
        pass
    elif rechts1.value()==pressed:
        gang -= 1
        if gang < gang_min:
            gang = gang_min
    elif rechts2.value()==pressed:
        gang = 0
    elif rechts3.value()==pressed:
        gang += 1
        if gang > gang_max:
            gang = gang_max
    print(gang)