void autonomous() { autonomousInit(); while(isAuto) { autonomousPeriodic(); if(isOnline()) { if(!isAutonomous() || !isEnabled()) isAuto = 0; } delay(20); puts("Autonomous"); } }
void Robot::doPeriodic() { switch(mode) { case DISABLED: { if(reinit == true) { disableInit(); reinit = false; } disablePeriodic(); }break; case TELEOP: { if(reinit == true) { teleopInit(); reinit = false; } teleopPeriodic(); }break; case AUTONOMOUS: { if(reinit == true) { autonomousInit(); reinit = false; } autonomousPeriodic(); }break; defualt: { if(reinit == true) { printf("Robot::%s::%d: Error, Unknown mode\n"); reinit = false; } }break; } }