Lab 3 Group 3 Report
Lab 3 Group 3 Report
# brain initialization
brain = Brain()
#motors initialization
right_motor = Motor(Ports.PORT12)
left_motor = Motor(Ports.PORT11)
#sensors initialization
claw_motor = Motor(Ports.PORT7)
sonar_sensor = Sonar(Ports.PORT1)
color_sensor = Colorsensor(Ports.PORT8, False)
#task 1
# def sonar_claw():
#task 2
# def color_arm():
#task 3
def move_forward(duration):
left_motor.spin(FORWARD, 80, PERCENT)
right_motor.spin(REVERSE, 80, PERCENT)
vex.wait(duration)
left_motor.stop()
right_motor.stop()
def turn_90deg(duration):
left_motor.spin(REVERSE, 80, PERCENT)
right_motor.spin(REVERSE, 80, PERCENT)
vex.wait(duration)
left_motor.stop()
right_motor.stop()
def claw_open():
claw_motor.spin_to(-120)
def claw_close():
claw_motor.spin_to(0)
# Task 3: get the bottle and stop when detects red colors
def stop_robot():
get_bottle()
while True:
color_sensor.led(True)
left_motor.spin(FORWARD, 50, PERCENT)
right_motor.spin(REVERSE, 50, PERCENT)
color = color_sensor.colorname12()
print(color)
if color == 1 or color == 2 or color == 12 or color == 3:
left_motor.stop()
right_motor.stop()
claw_motor.spin_to(-120)
break
stop_robot()