class Frank:
def __init__(self):
print "Set mode BCM"
GPIO.setmode(GPIO.BCM)
self.motorX = Motor([6, 13, 19, 26])
#self.motorY = Motor([])
#self.sensor = Sensor(4)
self.setUpScreen()
def setUpScreen(self):
self.screen = curses.initscr()
# turn off input echoing
curses.noecho()
# respond to keys immediately (don't wait for enter)
curses.cbreak()
# map arrow keys to special values
self.screen.keypad(True)
def isArrowKey(self, char):
return char in [curses.KEY_RIGHT,curses.KEY_LEFT, curses.KEY_UP, curses.KEY_DOWN]
def start(self):
try:
char = self.screen.getch()
while True :
while self.isArrowKey():
if char == curses.KEY_RIGHT:
print 'right'
self.motorX.moveTo(Motor.RIGHT)
elif char == curses.KEY_LEFT:
print 'left '
self.motorX.moveTo(Motor.LEFT)
elif char == curses.KEY_UP :
print 'up'
elif char == curses.KEY_DOWN :
print 'down'
char = self.screen.getch()
if char == ord('q'):
self.cleanUp()
break
else:
char = self.screen.getch()
finally:
# shut down cleanly
curses.nocbreak(); self.screen.keypad(0); curses.echo()
curses.endwin()
def cleanUp(self):
GPIO.cleanup()
exit(0)
direction = sys.argv[2]
if direction not in ['l', 'r']:
print "Direction should be 'l' or 'r'"
exit(0)
try:
distance = int(sys.argv[3])
except ValueError:
print "Distance should be a integer"
exit(0)
print "Motor " + motor_leter
print "Direccion " + direction
print "Distance %d" % distance
print "Set mode BCM"
config = json.load(open("config.json"))
GPIO.setmode(GPIO.BCM)
motor = Motor(config["motor_" + motor_leter]["pins"])
motor.delay = config["motor_" + motor_leter]["delay"]
motor.steps_by_mm = config["motor_" + motor_leter]["steps_by_mm"]
dir = Motor.RIGHT
if direction == 'l':
dir = Motor.LEFT
for x in range(0, int(distance * motor.steps_by_mm)):
motor.moveTo(dir)