format=log_format,
datefmt=log_datefmt)
log = logging.getLogger(__name__)
# Our own stuff
log.info("Starting up.")
p = Protocol(args.device)
time.sleep(2)
p.setMotor(0, 2, 0)
p.setMotor(1, 2, 0)
p.setServo(0, 450)
p.setServo(1, 450)
p.getCS()
p.getEN()
# Run while not ctrl-c'd
run = True
while run:
try:
p.handle()
k = p.read()
if k != None:
print k
except KeyboardInterrupt:
run = False
print "Caught CTRL+C, stopping ..."
# All done, clean up.
p.close()
