public static OI oi;
- private SendableChooser autoChooser;
+ public static AutonData autonData;
+ private SendableChooser autonChooser;
private Command autonomousCommand;
public void robotInit() {
pneumatics = new Pneumatics();
+ autonData = new AutonData();
+
chooseAuto();
}
public void autonomousInit() {
schedule(new TurnOnCompressor());
- autonomousCommand = (Command) autoChooser.getSelected();
+ autonData.update();
+
+ autonomousCommand = (Command) autonChooser.getSelected();
autonomousCommand.start();
}
}
private void chooseAuto() {
- autoChooser = new SendableChooser();
+ autonChooser = new SendableChooser();
- autoChooser.addDefault("Pick up container", new ContainerOverStep());
- autoChooser.addObject("Drive over step", new DriveOverStep());
- autoChooser.addObject("Drive past step", new DrivePastStep());
+ autonChooser.addDefault("Pick up container", new ContainerOverStep());
+ autonChooser.addObject("Drive over step", new DriveOverStep());
+ autonChooser.addObject("Drive past step", new DrivePastStep());
- SmartDashboard.putData("Auto Mode", autoChooser);
+ SmartDashboard.putData("Auto Mode", autonChooser);
}
private void schedule(Command c) {