virtual void TeleopPeriodic(){
Scheduler::GetInstance()->Run();
/*
if (CommandBase::GetOIInstance()->GetRawButton(1,3) && !armLevel->IsRunning()){
armLevel = new ArmLevel((float)45.0);
armLevel->Start();
} else if (CommandBase::GetOIInstance()->GetRawButton(1,2) && !armLevel->IsRunning()){
armLevel = new ArmLevel((float)-45.0);
armLevel->Start();
}
if (CommandBase::GetOIInstance()->GetRawButton(2,3) && armLevel->IsRunning()){
armLevel->Cancel();
delete(armLevel);
}
if (CommandBase::GetOIInstance()->GetRawButton(2,3) && armLevel->IsRunning()){
armLevel->Cancel();
delete(armLevel);
}
if (CommandBase::GetOIInstance()->GetRawButton(1,4)){// && !turn->IsRunning()){
new ShootGroup();
//turn = new Turn();
//turn->Start();
} else if (CommandBase::GetOIInstance()->GetRawButton(1,5)){// && !turn->IsRunning()){
new ShootGroup();
}
*/
if (CommandBase::GetOIInstance()->GetRawButton(1,1) && !autonomousCommand->IsRunning()){// && turn->IsRunning()){
delete autonomousCommand; autonomousCommand = NULL;
autonomousCommand = new AutoGroup();
autonomousCommand->Start();
}
//if (CommandBase::GetOIInstance()->GetRawButton(1,3) && !autonomousCommand->IsRunning()){// && turn->IsRunning()){
// autonomousCommand = new DAG();
// autonomousCommand->Start();
//}
}
