+
+ public Value getPistonValue() {
+ return piston.get();
+ }
+
+ public void setHighGear() {
+ changeGear(Constants.Shooter.HIGH_GEAR);
+ }
+
+ public void setLowGear() {
+ changeGear(Constants.Shooter.LOW_GEAR);
+ }
+
+ private void changeGear(DoubleSolenoid.Value gear) {
+ piston.set(gear);
+ }
+
+ public boolean isShooterRPMAtTargetSpeed() {
+ return isShooterRPMWithinRangeOfTargetSpeed(ACCEPTABLE_SHOOTING_DEVIATION);
+ }
+
+ public boolean isShooterRPMWithinRangeOfTargetSpeed(int acceptableRPMError) {
+ double shooterSpeed = getShooterRPM();
+ if (shooterSpeed > DEFAULT_SHOOTING_SPEED - acceptableRPMError
+ && shooterSpeed < DEFAULT_SHOOTING_SPEED + acceptableRPMError) {
+ return true;
+ }
+ return false;
+ }