THE MOMENT OF TRUTH

twas a success

diff --git a/src/main/java/frc/robot/subsystems/spindexer/Spindexer.java b/src/main/java/frc/robot/subsystems/spindexer/Spindexer.java
index 011379bed2deb572334a49d4e9e2a2dc818e3031..6abf1106298e1f2c2ae52e6a7fc71d5af67a11bf 100644 (file)
--- a/src/main/java/frc/robot/subsystems/spindexer/Spindexer.java
+++ b/src/main/java/frc/robot/subsystems/spindexer/Spindexer.java
@@ -56,6 +56,9 @@ public class Spindexer extends SubsystemBase implements SpindexerIO {
     slot0.kV = 0.11;
     slot0.kA = 0.0;
 
+    configs.MotionMagic.MotionMagicAcceleration = 999;
+    configs.MotionMagic.MotionMagicJerk = 0;
+
     motorOne.getConfigurator().apply(configs);
     motorTwo.getConfigurator().apply(configs);
     motorOne.getConfigurator().apply(limitConfig);
@@ -106,11 +109,6 @@ public class Spindexer extends SubsystemBase implements SpindexerIO {
 
   @Override
   public void periodic() {
-    tuner.periodic();
-
-  }
-
-  public void periodicDEATH() {
     updateInputs();
     Logger.processInputs("Spindexer", inputs);
 
@@ -146,8 +144,10 @@ public class Spindexer extends SubsystemBase implements SpindexerIO {
   }
 
   public void setMotorVoltages(double voltage) {
-    motorOne.setControl(new VoltageOut(voltage * 12).withEnableFOC(true));
-    motorTwo.setControl(new VoltageOut(voltage * 12).withEnableFOC(true));
+    // motorOne.setControl(new VoltageOut(voltage * 12).withEnableFOC(true));
+    // motorTwo.setControl(new VoltageOut(voltage * 12).withEnableFOC(true));
+    motorOne.setControl(velocityRequest.withVelocity(voltage * SpindexerConstants.MAX_RPM));
+    motorTwo.setControl(velocityRequest.withVelocity(voltage * SpindexerConstants.MAX_RPM));
   }
 
   public void maxSpindexer() {

diff --git a/src/main/java/frc/robot/subsystems/spindexer/SpindexerConstants.java b/src/main/java/frc/robot/subsystems/spindexer/SpindexerConstants.java
index 54b026ea37c2b03d7ffdd554dc3bb8fde640fd63..3fe1ea934c137c738eb01d5cd0fe70a53ed26721 100644 (file)
--- a/src/main/java/frc/robot/subsystems/spindexer/SpindexerConstants.java
+++ b/src/main/java/frc/robot/subsystems/spindexer/SpindexerConstants.java
@@ -14,4 +14,5 @@ public class SpindexerConstants {
     public static final double JAM_VELOCITY_THRESHOLD = 10.0; // A
     public static final double JAM_DEBOUNCE_TIME = 0.3; // seconds
     public static final double REVERSE_DEBOUNCE_TIME = 0.25; // seconds
+    public static final double MAX_RPM = 140;
 }