import edu.wpi.first.wpilibj.smartdashboard.SmartDashboard;
import org.usfirst.frc.team3501.robot.autons.*;
+import org.usfirst.frc.team3501.robot.commands.*;
import org.usfirst.frc.team3501.robot.subsystems.*;
public class Robot extends IterativeRobot {
}
public void autonomousInit() {
- pneumatics.start();
+ schedule(new TurnOnCompressor());
autonomousCommand = (Command) autoChooser.getSelected();
autonomousCommand.start();
}
public void teleopInit() {
- pneumatics.start();
+ schedule(new TurnOnCompressor());
autonomousCommand.cancel();
}
}
public void disabledInit() {
- pneumatics.stop();
+ schedule(new TurnOffCompressor());
}
private void chooseAuto() {
SmartDashboard.putData("Auto Mode", autoChooser);
}
+
+ private void schedule(Command c) {
+ Scheduler.getInstance().add(c);
+ }
}