Untitled
unknown
plain_text
5 years ago
1.5 kB
9
Indexable
from RpiMotorLib import RpiMotorLib
import RPi.GPIO as GPIO
import time
#define buttons layout
GPIO.setwarnings(False)
GPIO.setmode(GPIO.BCM)
GPIO.setup(2, GPIO.IN, pull_up_down=GPIO.PUD_UP)
GPIO.setup(27, GPIO.IN, pull_up_down=GPIO.PUD_UP)
GPIO.setup(4, GPIO.IN, pull_up_down=GPIO.PUD_UP)
GPIO.setup(17, GPIO.IN, pull_up_down=GPIO.PUD_UP)
#define GPIO pins horitzontal
motor_h_GPIO_pins = (14, 15, 18)
motor_h_direction= 20
motor_h_step = 21
motor_h_distance = 500 # Default move 1mm => 80 steps per mm
#define GPIO pins vertical
motor_v_GPIO_pins = (5, 6, 13)
motor_v_direction= 26
motor_v_step = 19
motor_v_distance = 500 # Default move 1mm => 80 steps per mm
motor_v = RpiMotorLib.A4988Nema(
motor_v_direction,
motor_v_step,
motor_v_GPIO_pins,
"A4988"
)
motor_h = RpiMotorLib.A4988Nema(
motor_h_direction,
motor_h_step,
motor_h_GPIO_pins,
"A4988"
)
while True:
if GPIO.input(2) == GPIO.LOW:
print('LEFT')
print('button 2')
motor_h.motor_go(False, "1/16", motor_h_distance)
if GPIO.input(27) == GPIO.LOW:
print('UP')
print('button 27')
motor_v.motor_go(False, "1/16", motor_v_distance)
if GPIO.input(4) == GPIO.LOW:
print('DOWN')
print('button 4')
motor_v.motor_go(True, "1/16", motor_v_distance)
if GPIO.input(17) == GPIO.LOW:
print('RIGHT')
print('button 17')
motor_h.motor_go(True, "1/16", motor_h_distance)
else:
print("Nothing!")
time.sleep(.5)
Editor is loading...