def __init__(self):
self.TapeLabels={'ST','RA', 'RB', 'S'}
self.Tape=""
self.tapes = [
t.Tape('ST', ['1','1','1','1'], 0),
t.Tape('RA', ['1','1','1','1'], 0),
t.Tape('RB', ['1','1','1','1'], 0),
t.Tape('S', ['1','1','1','1'], 0)]
def run():
t = tape.Tape()
print("REPL for BF interpreter. Enter 'exit' to close shell.")
while (True):
cmd = input(">> ")
if cmd == 'exit':
print("Shell aborted.")
return
scan_char(cmd, t)
print() # Newline
def init_fita(self, conteudo_fitas, qtd, fita, simbolo_branco):
"""
Inicia um vetor de objetos Tape
:param self: objeto TuringMachine
:param conteudo_fitas: vetor de conteudo de cada fita
:param qtd: quantidade de fitas
:param fita: alfabeto da fita
:param simbolo_branco: simbolo "Branco"
"""
fitas = []
for i in range(int(qtd)):
fitas.append(tape.Tape(fita, conteudo_fitas[i], simbolo_branco))
return fitas
def setUp(self):
self.tape = tape.Tape('t1', ['0','0','0','0'],0)
pass
config.TAPE_Y_SERVO_MAX_PULSE)
# Create component objects
tableObj = table.Table(leadScrewMotor, tableLimit, config.TABLE_HOME_DIR,
config.TABLE_MIN_POS, config.TABLE_MAX_POS)
rodXObj = rod.Rod(rodCarrXMotor, rodXMotor, rodCarrXLimit,
config.ROD_X_AXIS_HOME_DIR,
config.RODCARR_X_MIN_POS, config.RODCARR_X_MAX_POS)
rodYObj = rod.Rod(rodCarrYMotor, rodYMotor, rodCarrYLimit,
config.ROD_Y_AXIS_HOME_DIR,
config.RODCARR_Y_MIN_POS, config.RODCARR_Y_MAX_POS)
tapeXLeftObj = tape.Tape(tapeCarrXLeftMotor, tapeXMotors, tapeCamXLeftMotor,
tapeCarrXLeftLimit, config.TAPE_X_AXIS_LEFT_HOME_DIR,
config.TAPE_HOME_DIR,
config.TAPECARR_X_LEFT_MIN_POS,
config.TAPECARR_X_LEFT_MAX_POS,
config.TAPE_MIN_POS,
config.TAPE_MAX_POS,
config.TAPE_CAM_MIN_POS,
config.TAPE_CAM_MAX_POS)
tapeXRightObj = tape.Tape(tapeCarrXRightMotor, tapeXMotors, tapeCamXRightMotor,
tapeCarrXRightLimit, config.TAPE_X_AXIS_RIGHT_HOME_DIR,
config.TAPE_HOME_DIR,
config.TAPECARR_X_RIGHT_MIN_POS,
config.TAPECARR_X_RIGHT_MAX_POS,
config.TAPE_MIN_POS,
config.TAPE_MAX_POS,
config.TAPE_CAM_MIN_POS,
config.TAPE_CAM_MAX_POS)
tapeYObj = tape.Tape(tapeCarrYMotor, tapeYMotor, tapeCamYMotor,
tapeCarrYLimit, config.TAPE_Y_AXIS_HOME_DIR,
def startEventLoop():
# Create MCP and PWM hat objects
busnum = 1
mcpList = [Adafruit_GPIO.MCP230xx.MCP23017(address = addr, busnum = busnum) for addr in pins.MCP23017_ADDR]
pwm = Adafruit_PCA9685.PCA9685(pins.PWM_HAT_ADDR)
# Initialize pins of MCP
for i, mcp in enumerate(mcpList):
for j in range(mcp.NUM_GPIO):
mcp.setup(j, pins.MCP23017_PINS[i][j])
if pins.MCP23017_PINS[i][j] == RPi.GPIO.IN:
mcp.pullup(j, True)
# Create button object
startButton = button.PushButton(mcpList[pins.PUSH_BUTTON_MCP], pins.PUSH_BUTTON_PIN)
# Create limit switch objects
tableLimit = limit.LimitSwitch(mcpList[pins.LIMIT_MCP], pins.TABLE_LIMIT_PIN)
rodCarrXLimit = limit.LimitSwitch(mcpList[pins.LIMIT_MCP],
pins.RODCARR_X_AXIS_LIMIT_PIN)
rodCarrYLimit = limit.LimitSwitch(mcpList[pins.LIMIT_MCP],
pins.RODCARR_Y_AXIS_LIMIT_PIN)
tapeCarrXLeftLimit = limit.LimitSwitch(mcpList[pins.LIMIT_MCP],
pins.TAPECARR_X_AXIS_LEFT_LIMIT_PIN)
tapeCarrXRightLimit = limit.LimitSwitch(mcpList[pins.LIMIT_MCP],
pins.TAPECARR_X_AXIS_RIGHT_LIMIT_PIN)
tapeCarrYLimit = limit.LimitSwitch(mcpList[pins.LIMIT_MCP],
pins.TAPECARR_Y_AXIS_LIMIT_PIN)
# Create motor objects
leadScrewMotor = motor.StepperMotor(mcpList[pins.TABLE_MCP],
pwm,
pins.TABLE_DIR_PIN,
pins.TABLE_RST_PIN,
pins.TABLE_STEP_PWM_CHANNEL,
config.TABLE_STEPS_PER_REV)
rodCarrXMotor = motor.StepperMotor(mcpList[pins.RODCARR_MCP],
pwm,
pins.RODCARR_X_AXIS_DIR_PIN,
pins.RODCARR_X_AXIS_RST_PIN,
pins.RODCARR_X_AXIS_STEP_PWM_CHANNEL,
config.CARR_STEPS_PER_REV)
rodCarrYMotor = motor.StepperMotor(mcpList[pins.RODCARR_MCP],
pwm,
pins.RODCARR_Y_AXIS_DIR_PIN,
pins.RODCARR_Y_AXIS_RST_PIN,
pins.RODCARR_Y_AXIS_STEP_PWM_CHANNEL,
config.CARR_STEPS_PER_REV)
rodXMotor = motor.DCMotor(mcpList[pins.ROD_MCP],
pwm,
pins.ROD_X_AXIS_DIR_PIN,
pins.ROD_X_AXIS_STEP_PWM_CHANNEL)
rodYMotor = motor.DCMotor(mcpList[pins.ROD_MCP],
pwm,
pins.ROD_Y_AXIS_DIR_PIN,
pins.ROD_Y_AXIS_STEP_PWM_CHANNEL)
tapeCarrXLeftMotor = motor.StepperMotor(mcpList[pins.TAPECARR_MCP],
pwm,
pins.TAPECARR_X_AXIS_LEFT_DIR_PIN,
pins.TAPECARR_X_AXIS_LEFT_RST_PIN,
pins.TAPECARR_X_AXIS_LEFT_STEP_PWM_CHANNEL,
config.CARR_STEPS_PER_REV)
tapeCarrXRightMotor = motor.StepperMotor(mcpList[pins.TAPECARR_MCP],
pwm,
pins.TAPECARR_X_AXIS_RIGHT_DIR_PIN,
pins.TAPECARR_X_AXIS_RIGHT_RST_PIN,
pins.TAPECARR_X_AXIS_RIGHT_STEP_PWM_CHANNEL,
config.CARR_STEPS_PER_REV)
tapeCarrYMotor = motor.StepperMotor(mcpList[pins.TAPECARR_MCP],
pwm,
pins.TAPECARR_Y_AXIS_DIR_PIN,
pins.TAPECARR_Y_AXIS_RST_PIN,
pins.TAPECARR_Y_AXIS_STEP_PWM_CHANNEL,
config.CARR_STEPS_PER_REV)
tapeXMotors = motor.StepperMotor(mcpList[pins.TAPE_MCP],
pwm,
pins.TAPE_X_AXIS_DIR_PIN,
pins.TAPE_X_AXIS_RST_PIN,
pins.TAPE_X_AXIS_STEP_PWM_CHANNEL,
config.TAPE_STEPS_PER_REV)
tapeYMotor = motor.StepperMotor(mcpList[pins.TAPE_MCP],
pwm,
pins.TAPE_Y_AXIS_DIR_PIN,
pins.TAPE_Y_AXIS_RST_PIN,
pins.TAPE_Y_AXIS_STEP_PWM_CHANNEL,
config.TAPE_STEPS_PER_REV)
tapeCamXLeftMotor = motor.ServoMotor(pwm, pins.TAPECAM_X_AXIS_LEFT_STEP_PWM_CHANNEL)
tapeCamXRightMotor = motor.ServoMotor(pwm, pins.TAPECAM_X_AXIS_RIGHT_STEP_PWM_CHANNEL)
tapeCamYMotor = motor.ServoMotor(pwm, pins.TAPECAM_Y_AXIS_STEP_PWM_CHANNEL)
# Create component objects
tableObj = table.Table(leadScrewMotor, tableLimit, config.TABLE_HOME_DIR)
rodXObj = rod.Rod(rodCarrXMotor, rodXMotor, rodCarrXLimit, config.ROD_X_AXIS_HOME_DIR)
rodYObj = rod.Rod(rodCarrYMotor, rodYMotor, rodCarrYLimit, config.ROD_Y_AXIS_HOME_DIR)
tapeXLeftObj = tape.Tape(tapeCarrXLeftMotor, tapeXMotors, tapeCamXLeftMotor,
tapeCarrXLeftLimit, config.TAPE_X_AXIS_LEFT_HOME_DIR)
tapeXRightObj = tape.Tape(tapeCarrXRightMotor, tapeXMotors, tapeCamXRightMotor,
tapeCarrXRightLimit, config.TAPE_X_AXIS_RIGHT_HOME_DIR)
tapeYObj = tape.Tape(tapeCarrYMotor, tapeYMotor, tapeCamYMotor,
tapeCarrYLimit, config.TAPE_Y_AXIS_HOME_DIR)
# Enable table motors
tableObj.enable()
rodXObj.enable()
rodYObj.enable()
tapeXLeftObj.enable()
tapeXRightObj.enable()
tapeYObj.enable()
while True:
ctrl = raw_input("""
Control the following:
t - table
rx - x rod
ry - y rod
txl - x left tape
txr - x right tape
ty - y tape
b - button
q - quit]""")
if ctrl == 't':
while True:
dist = 1
a = raw_input("""
0 - lift dist of %d
1 - lower dist of %d
2 - enable table
3 - disable table
4 - home
""" % (dist, dist))
if a == '0':
tableObj.lift(dist, 1)
elif a == '1':
tableObj.lower(dist, 1)
elif a == '2':
tableObj.enable()
elif a == '3':
tableObj.disable()
elif a == '4':
tableObj.home()
elif a == 'q':
break
else:
pass
elif ctrl == 'rx':
while True:
dist = 1
a = raw_input("""
0 - move dist of %d clockwise
1 - move dist of %d counter clockwise
2 - rotate rod clockwise
3 - rotate rod counter clockwise
4 - enable carraige motor
5 - disable carriage motor
6 - stop rod
7 - home carriage
q - quit""" % (dist, dist))
if a == '0':
rodXObj.move(dist, 1)
elif a == '1':
rodXObj.move(-dist, 1)
elif a == '2':
rodXObj.rotate(config.DC_MAX_RPM, config.DC_ROT_CW)
elif a == '3':
rodXObj.rotate(config.DC_MAX_RPM, config.DC_ROT_CCW)
elif a == '4':
rodXObj.enable()
elif a == '5':
rodXObj.disable()
elif a == '6':
rodXObj.stop()
elif a == '7':
rodXObj.home()
elif a == 'q':
break
else:
pass
elif ctrl == 'ry':
while True:
dist = 1
a = raw_input("""
0 - move dist of %d clockwise
1 - move dist of %d counter clockwise
2 - rotate rod clockwise
3 - rotate rod counter clockwise
4 - enable carraige motor
5 - disable carriage motor
6 - stop rod
7 - home carriage
q - quit""" % (dist, dist))
if a == '0':
rodYObj.move(dist, 1)
elif a == '1':
rodYObj.move(-dist, 1)
elif a == '2':
rodYObj.rotate(config.DC_MAX_RPM, config.DC_ROT_CW)
elif a == '3':
rodYObj.rotate(config.DC_MAX_RPM, config.DC_ROT_CCW)
elif a == '4':
rodYObj.enable()
elif a == '5':
rodYObj.disable()
elif a == '6':
rodYObj.stop()
elif a == '7':
rodYObj.home()
elif a == 'q':
break
else:
pass
elif ctrl == 'txl':
while True:
dist = 1
extDist = 1
a = raw_input("""
0 - move dist of %d clockwise
1 - move dist of %d counter clockwise
2 - extend tape dist of %d
3 - retract tape dist of %d
4 - set cam min position
5 - set cam max position
6 - enable carraige and tape motor
7 - disable carriage and tape motor
8 - home carriage
q - quit""" % (dist, dist, extDist, extDist))
if a == '0':
tapeXLeftObj.move(dist, 1)
elif a == '1':
tapeXLeftObj.move(-dist, 1)
elif a == '2':
tapeXLeftObj.extend(extDist, 1)
elif a == '3':
tapeXLeftObj.retract(extDist, 1)
elif a == '4':
tapeXLeftObj.setCamHeight(0)
elif a == '5':
tapeXLeftObj.setCamHeight(config.TAPE_CAM_LENGTH)
elif a == '6':
tapeXLeftObj.enable()
elif a == '7':
tapeXLeftObj.disable()
elif a == '8':
tapeXLeftObj.home()
elif a == 'q':
break
else:
pass
elif ctrl == 'txr':
while True:
dist = 1
extDist = 1
a = raw_input("""
0 - move dist of %d clockwise
1 - move dist of %d counter clockwise
2 - extend tape dist of %d
3 - retract tape dist of %d
4 - set cam min position
5 - set cam max position
6 - enable carraige and tape motor
7 - disable carriage and tape motor
8 - home carriage
q - quit""" % (dist, dist, extDist, extDist))
if a == '0':
tapeXRightObj.move(dist, 1)
elif a == '1':
tapeXRightObj.move(-dist, 1)
elif a == '2':
tapeXRightObj.extend(extDist, 1)
elif a == '3':
tapeXRightObj.retract(extDist, 1)
elif a == '4':
tapeXRightObj.setCamHeight(0)
elif a == '5':
tapeXRightObj.setCamHeight(config.TAPE_CAM_LENGTH)
elif a == '6':
tapeXRightObj.enable()
elif a == '7':
tapeXRightObj.disable()
elif a == '8':
tapeXRightObj.home()
elif a == 'q':
break
else:
pass
elif ctrl == 'ty':
while True:
dist = 1
extDist = 1
a = raw_input("""
0 - move dist of %d clockwise
1 - move dist of %d counter clockwise
2 - extend tape dist of %d
3 - retract tape dist of %d
4 - set cam min position
5 - set cam max position
6 - enable carraige and tape motor
7 - disable carriage and tape motor
8 - home carriage
q - quit""" % (dist, dist, extDist, extDist))
if a == '0':
tapeYObj.move(dist, 1)
elif a == '1':
tapeYObj.move(-dist, 1)
elif a == '2':
tapeYObj.extend(extDist, 1)
elif a == '3':
tapeYObj.retract(extDist, 1)
elif a == '4':
tapeYObj.setCamHeight(0)
elif a == '5':
tapeYObj.setCamHeight(config.TAPE_CAM_LENGTH)
elif a == '6':
tapeYObj.enable()
elif a == '7':
tapeYObj.disable()
elif a == '8':
tapeYObj.home()
elif a == 'q':
break
else:
pass
elif ctrl == 'b':
print("Waiting for button press")
startButton.waitForButtonPress()
elif ctrl == 'q':
break
else:
pass