public void teleopInit() {
START_TIME = System.currentTimeMillis();
if (autonomousCommand != null && autonomousCommand.isRunning()) {
autonomousCommand.cancel();
}
if (driveChooser.getSelected() != null) {
((Command) driveChooser.getSelected()).start();
}
intakeArm.initDefaultCommand();
intakeWheel.initDefaultCommand();
liftClimb.initDefaultCommand();
climbPiston.initDefaultCommand();
}
// Make this return true when this Command no longer needs to run execute()
protected boolean isFinished() {
return !command.isRunning();
}
