// Called repeatedly when this Command is scheduled to run
@Override
protected void execute() {
- shooter.setIndexWheelMotorVal(shooter.DEFAULT_INDEXING_SPEED);
+ double shooterSpeed = shooter.getShooterRPM();
+ double targetShooterSpeed = shooter.getTargetShootingSpeed();
+ double threshold = shooter.getRPMThreshold();
+ if (Math.abs(shooterSpeed - targetShooterSpeed) <= threshold)
+ shooter.runIndexWheel();
}
// Called once after isFinished returns true