task fullAuton(){
autoShootGo();
wait1Msec(2000);
intakeGo();
wait1Msec(2000);
intakeStop();
wait1Msec(2000);
autoShootGo();
wait1Msec(2000);
intakeGo();
wait1Msec(2000);
intakeStop();
wait1Msec(2000);
autoShootGo();
wait1Msec(2000);
intakeGo();
wait1Msec(2000);
intakeStop();
wait1Msec(2000);
autoShootGo();
wait1Msec(2000);
intakeGo();
wait1Msec(2000);
intakeStop();
wait1Msec(2000);
}
void passPreload()
{
armHeight(ARM_PASS_HEIGHT);
intakeOut();
wait1Msec(500);
intakeStop();
armHeight(0);
}
void setIntake() // reads the Joystick, determines the state of the intake and sends values to motors - used in driver control
{
if(vexRT[Btn6U] == 1) // if button 6 Up is pressed...
{intakeIn();} // ...intake balls.
else if(vexRT[Btn6D] == 1) // if button 6 Down is pressed...
{intakeOut();} // ...outtake balls (possibly at reduced speed).
else // if neither button is pressed...
{intakeStop();} // ...stop the motors.
}
void compReset(int not, int not2){
if(not != 2){
intakeStop();
}
if( not!= 3){
beltStop();
}
if(not != 1){
spinLauncherFix(0, 10);
}
}
