def swap_left_and_middle():
robot.drive_right()
robot.lift_up()
robot.gripper_to_open()
robot.lift_down()
robot.gripper_to_closed()
robot.lift_up()
robot.drive_right()
robot.drive_right()
robot.gripper_to_open()
robot.lift_down()
robot.gripper_to_closed()
robot.drive_left()
robot.drive_left()
robot.gripper_to_open()
robot.lift_up()
robot.gripper_to_closed()
robot.drive_right()
robot.drive_right()
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 make_tower():
count = 0
while robot.sense_color() != "":
count = count + 1
robot.drive_right()
robot.drive_right()
boxes = count
while boxes > 0:
robot.drive_left()
robot.drive_left()
boxes = boxes - 1
robot.lift_up()
robot.gripper_to_open()
robot.drive_right()
robot.lift_down()
robot.gripper_to_closed()
while boxes < (count - 1):
boxes = boxes + 1
robot.lift_up()
robot.drive_right()
robot.drive_right()
robot.gripper_to_open()
robot.lift_down()
if boxes != count - 1:
robot.gripper_to_closed()
def swap_right_left():
swap_left_mid()
swap_right_mid()
robot.lift_up()
robot.drive_left()
robot.drive_left()
robot.lift_down()
robot.gripper_to_closed()
move()
def move():
robot.lift_up()
robot.drive_right()
robot.drive_right()
robot.gripper_to_open()
robot.lift_down()
robot.gripper_to_closed()
robot.drive_left()
robot.drive_left()
robot.gripper_to_open()
robot.lift_up()
robot.gripper_to_closed()
robot.drive_right()
robot.drive_right()
robot.lift_down()
robot.gripper_to_open()
def swap_middle_and_right():
robot.drive_right()
robot.drive_right()
robot.gripper_to_open()
robot.lift_down()
robot.gripper_to_closed()
#blue box is in gripper!
robot.drive_left()
robot.drive_left()
robot.gripper_to_open()
#blue box is in the middle!
robot.lift_up()
robot.gripper_to_closed()
robot.drive_right()
robot.drive_right()
robot.lift_down()
robot.gripper_to_open()
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()
#greem box is on the right!
robot.gripper_to_open()
robot.lift_up()
robot.gripper_to_closed()
robot.drive_right()
robot.drive_right()
def swap_right_mid():
robot.lift_up()
robot.drive_right()
robot.drive_right()
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()
def left_two_spaces(): #name of this function was wrong by added an extra "_ß"
robot.drive_left()
robot.drive_left()
def left_two_spaces():
robot.drive_left()
robot.drive_left()
def left_two_spaces(): #-----------Delete one more "_" to correct the name!
robot.drive_left()
robot.drive_left()
def move_2steps_left():
robot.drive_left()
robot.drive_left()
