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)
