import RPi.GPIO as GPIO
from time import sleep
import readchar


GPIO.setmode(GPIO.BOARD)

GPIO.setup(3, GPIO.OUT) #reverse
GPIO.setup(5, GPIO.OUT) #forward
GPIO.setup(8, GPIO.OUT) #left
GPIO.setup(10, GPIO.OUT) #right



print("steer with w,a,d")
print("forward r, reverse f")

while True:

        key=readchar.readkey()

        if key == "r":
            GPIO.output(5, GPIO.HIGH)
            sleep(1)
            GPIO.output(5, GPIO.LOW)

        elif key == "f":
            GPIO.output(3, GPIO.HIGH)
            sleep(1)
            GPIO.output(3, GPIO.LOW)

        elif key == "a":
            GPIO.output(10, GPIO.LOW)

            GPIO.output(8, GPIO.HIGH)


        elif key == "d":
            GPIO.output(8, GPIO.LOW)

            GPIO.output(10, GPIO.HIGH)


        elif key == "w":
            GPIO.output(8, GPIO.LOW)
            GPIO.output(10, GPIO.LOW)

        elif key == "z":
            GPIO.cleanup()
            print("Motors on safe, exiting.")
            sleep(1)
            break