3D Drucker Motortest.py

from time import sleep
import RPi.GPIO as GPIO

GPIO.setmode(GPIO.BOARD)
GPIO.setwarnings(False)
# Anschluesse auf dem Board

A=12
B=16
C=18
D=22

# Variablen erstellen

# Pausenzeit
delay = 0.0055
# Umdrehungen
steps = 70
# Aussenschleife
loop = 4

# GPIO Pins vorbereiten
GPIO.setup(A,GPIO.OUT)
GPIO.setup(B,GPIO.OUT)
GPIO.setup(C,GPIO.OUT)
GPIO.setup(D,GPIO.OUT)
GPIO.output(A, False)
GPIO.output(B, False)
GPIO.output(C, False)
GPIO.output(D, False)

# Procedur mit vier zu uebergebenden Werten
def setStep(w1, w2, w3, w4):
GPIO.output(A, w1)
GPIO.output(B, w2)
GPIO.output(C, w3)
GPIO.output(D, w4)

# Aeussere Schleife

for x in range(0, loop):

# Innere Schleife vorwaerts

for i in range(0, steps):
setStep(1,0,1,0)
sleep(delay)
setStep(0,1,1,0)
sleep(delay)
setStep(0,1,0,1)
sleep(delay)
setStep(1,0,0,1)
sleep(delay)
print i

# Innere Schleife rueckwaerts

for i in range(0, steps):
setStep(1,0,0,1)
sleep(delay)
setStep(0,1,0,1)
sleep(delay)
setStep(0,1,1,0)
sleep(delay)
setStep(1,0,1,0)
sleep(delay)
print i

# GPIO Pins aufraeumen
GPIO.cleanup()