def test(): # Rover init RM.port_init() RM.motor_gpio_init() RM.print_port_info() # Servor init CM.servo_init() CM.move_to_center() while True: cmd = raw_input("command, l/r/s or fx or bx x is second:, u-up,d-down") if cmd[0] == "r": if len(cmd) == 1: speed = 8 else: speed = int(cmd[1]) RM.turn_right_speed(speed) elif cmd[0] == "l": if len(cmd) == 1: speed = 8 else: speed = int(cmd[1]) RM.turn_left_speed(speed) elif cmd[0] == "f": if len(cmd) == 1: speed = 8 else: speed = int(cmd[1]) RM.move_forward_speed(speed) elif cmd[0] == "b": if len(cmd) == 1: speed = 8 else: speed = int(cmd[1]) RM.move_backward_speed(speed) elif cmd[0] == "s": RM.move_stop() CM.stop() elif cmd[0] == "u": CM.move_up(0.5) elif cmd[0] == "d": CM.move_down(0.5) elif cmd[0] == "q": RM.move_stop() CM.stop() print "BYE" exit(1) else: exit(1)