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;
}
}
