moveForward(LOW_FORWARD, 6); turnRight(85); moveForward(LOW_FORWARD, 15); // Poke the Wrench moveForward(-1 * MID_FORWARD, 30); moveForward(LOW_FORWARD, 4); // Ready for buttons turnRight(-90); moveForward(LOW_FORWARD, 1.5); pressButton(isBlue()); // Presses the button turnRight(90); moveForward(-1 * MID_FORWARD, 10); moveForward(LOW_FORWARD, 12); // Back to the center turnRight(90); moveForward(LOW_FORWARD, 10); moveForward(HIGH_FORWARD, 10); // Ram the finish button break;
Algorithm for Performance Test 2:
- Move forward out of starting area
- Turn right
- Move forward to poke the wrench
- Move backwards, squaring up
- Move forward
- Turn left
- Move forward, over the button board light
- Read the light, and press the corresponding button
- Turn right
- Move backwards, squaring up
- Move forward
- Turn right
- Move forward into the final button