|
|
@ -149,15 +149,16 @@ task autonomous() {
|
|
|
|
driveTiles(1, REVERSE);
|
|
|
|
driveTiles(1, REVERSE);
|
|
|
|
turnRight(1);
|
|
|
|
turnRight(1);
|
|
|
|
driveTiles(0.33, REVERSE);
|
|
|
|
driveTiles(0.33, REVERSE);
|
|
|
|
driveTiles(2.5, FORWARD);
|
|
|
|
driveTiles(2.5, FORWARD); // Flip the other cap without turning on the spinner
|
|
|
|
ballIn();
|
|
|
|
ballIn(); // So we can pick up the ball!
|
|
|
|
delay(100);
|
|
|
|
delay(1000);
|
|
|
|
driveTiles(0.1, FORWARD);
|
|
|
|
driveTiles(0.1, FORWARD);
|
|
|
|
turnLeft(1);
|
|
|
|
turnLeft(1);
|
|
|
|
driveTiles(0.33, REVERSE);
|
|
|
|
driveTiles(0.33, REVERSE);
|
|
|
|
delay(1000);
|
|
|
|
delay(1000);
|
|
|
|
ballOff();
|
|
|
|
ballOff();
|
|
|
|
shootBall();
|
|
|
|
shootBall();
|
|
|
|
|
|
|
|
driveTiles(2.2, FORWARD); // Hit middle column bottom flag
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
void turnRight(int turns) {
|
|
|
|
void turnRight(int turns) {
|
|
|
|