def swap_right_and_middle():
robot.drive_right()
robot.drive_right()
robot.drive_right()
robot.drive_right()
robot.drive_right()
robot.lift_up()
robot.gripper_to_open()
robot.lift_down()
robot.gripper_to_closed()
robot.lift_up()
robot.drive_left()
robot.drive_left()
robot.gripper_to_open()
robot.lift_down()
robot.gripper_to_closed()
robot.drive_right()
robot.drive_right()
robot.gripper_to_open()
robot.lift_up()
robot.gripper_to_closed()
robot.drive_left()
robot.drive_left()
robot.lift_down()
robot.gripper_to_open()
robot.lift_up()
robot.gripper_to_folded()
robot.drive_left()
robot.drive_left()
robot.drive_left()
robot.lift_down()
def right_two_spaces():
robot.drive_right()
robot.drive_right()
def move_to_next_stack():
'''move robot two steps right'''
robot.drive_right()
robot.drive_right()
import robot robot.init() robot.drive_right() robot.lift_up() robot.gripper_to_open() robot.lift_down() help(robot)
import robot
robot.init()
'''
robot.drive_right()
robot.lift_up()
robot.gripper_to_open()
robot.lift_down()
robot.gripper_to_closed()
'''
# robot can only open/folding on the top!!!!
def swap_left_and_middle():
robot.drive_right()
robot.lift_up()
robot.gripper_to_open()
robot.lift_down()
robot.gripper_to_closed()
# red box is in gripper!
robot.lift_up()
robot.drive_right()
robot.drive_right()
robot.gripper_to_open()
# red box is on the top of green box!
robot.lift_down()
robot.gripper_to_closed()
#green box is in gripper!
robot.drive_left()
robot.drive_left()
def swap_left_and_middle():
robot.drive_right()
pickup_and_replace()
def move_2steps_right():
robot.drive_right()
robot.drive_right()