log_datefmt = '%d.%m.%Y %I:%M:%S'
    logging.basicConfig(stream=log_out,
                        level=logging.INFO,
                        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 ..."