motorQueue = Queue.Queue()
cmdQueue = Queue.Queue()
sendQueue = Queue.Queue()
# Kick off motorControl thread
motorControl = MotorThread(motorQueue, sendQueue)
motorControl.start()
# Start server
netService = RobotNetworkService(cmdQueue, sendQueue)
netService.start()
msg = ""
while (msg != "quit"):
# TODO: Verify threads stay alive.
if (motorControl.isAlive() == False):
print 'Motor control thread died!'
break
if (netService.isAlive() == False):
print 'Network service thread died!'
break
# TODO: Require a heartbeat message from the remote
try:
msg = cmdQueue.get(True, 1)
except Queue.Empty:
# Not a bad thing, just need to check the exit conditions.
pass
else:
print 'Received command: ' + msg
words = msg.split()
motorQueue = Queue.Queue()
cmdQueue = Queue.Queue()
sendQueue = Queue.Queue()
# Kick off motorControl thread
motorControl = MotorThread(motorQueue, sendQueue)
motorControl.start()
# Start server
netService = RobotNetworkService(cmdQueue, sendQueue)
netService.start()
msg = ""
while (msg != "quit"):
# TODO: Verify threads stay alive.
if (motorControl.isAlive() == False):
print 'Motor control thread died!'
break
if (netService.isAlive() == False):
print 'Network service thread died!'
break
# TODO: Require a heartbeat message from the remote
try:
msg = cmdQueue.get(True, 1)
except Queue.Empty:
# Not a bad thing, just need to check the exit conditions.
pass
else:
print 'Received command: ' + msg
words = msg.split()
