edited shooter flywheel ready command

src/main/java/frc/robot/commands/shooter/flywheel/ShooterFlywheelReadyCommand.java

@@ -16,15 +16,10 @@ public void initialize() {
         shooterSubsystem.setShooterMotorSpeed(shooterSubsystem.SHOOTER_MOTOR_SPEED);
     }
 
-    //pivot: vertical, auto-aim
-    //feed: load, shoot
-    //shooter: stop, ready shooters
-
-    //load note
-    //shoot
-    //ready shooter
-    //vertical 
-    //auto-angle
+    @Override
+    public boolean isFinished(){
+        return (Math.abs(shooterSubsystem.getFlywheelSpeed() - shooterSubsystem.SHOOTER_MOTOR_SPEED) < shooterSubsystem.SPEED_TOLERANCE);
+    }
 
     @Override
     public void end(boolean interrupted) {

src/main/java/frc/robot/subsystems/shooter/ShooterFeederSubsystem.java

@@ -32,9 +32,10 @@ public ShooterFeederSubsystem(){
     public void setFeederMotorSpeed(double speed){
         feederMotor.set(TalonSRXControlMode.PercentOutput, speed);
         System.out.println("feeding motor speed is: " + feederMotor.getMotorOutputPercent());
-
     }
 
+
+
     public int getProximity(){
         System.out.println("proximity: " + shooterSensor.getProximity());
         return shooterSensor.getProximity();

src/main/java/frc/robot/subsystems/shooter/ShooterFlywheelSubsystem.java

@@ -14,13 +14,13 @@ public class ShooterFlywheelSubsystem extends SubsystemBase {
 
     //change later (ALL OF THEM ARE PLACEHOLDERS)
     int IDNUMBER = 10; //so I remember to change them later
-    // public static final int SHOOTER_MOTOR_ONE_ID = 13;
-    // public static final int SHOOTER_MOTOR_TWO_ID = 14;
     public final double SHOOTER_MOTOR_SPEED = 1;
+    public final double SPEED_TOLERANCE = 0.7;
 
     //motors
     private final CANSparkMax shooterMotor;
     private final CANSparkMax shooterMotorTwo;
+    private double currentSpeed;
 
     //devices
     private ShooterState currentState; //an enum state thing
@@ -54,7 +54,12 @@ public void setShooterState(ShooterState newState){
 
     public void setShooterMotorSpeed(double speed){
         shooterMotor.setVoltage(-speed * 12);
+        currentSpeed = speed;
         System.out.println("shooter motor speed is: " + shooterMotor.get());
     }
 
+    public double getFlywheelSpeed(){
+        return currentSpeed;
+    }
+
 }