fixed requested speeds

DeepBlueRobotics · Mar 2, 2024 · e472500 · e472500
1 parent 494eea0
commit e472500
Showing 1 changed file with 4 additions and 4 deletions.
diff --git a/src/main/java/org/carlmontrobotics/subsystems/Arm.java b/src/main/java/org/carlmontrobotics/subsystems/Arm.java
@@ -123,19 +123,19 @@ public void periodic() {
         autoCancelArmCommand();
     }
 
-   /*  public void autoCancelArmCommand() {
+  public void autoCancelArmCommand() {
         if(!(getDefaultCommand() instanceof ArmTeleop) || DriverStation.isAutonomous()) return;
 
-        double[] requestedSpeeds = ((ArmTeleop) getDefaultCommand()).getRequestedSpeeds();
+        double requestedSpeeds = ((ArmTeleop) getDefaultCommand()).getRequestedSpeeds();
 
-        if(requestedSpeeds[0] != 0 || requestedSpeeds[1] != 0) {
+        if(requestedSpeeds != 0) {
             Command currentArmCommand = getCurrentCommand();
             if(currentArmCommand != getDefaultCommand() && currentArmCommand != null) {
                 currentArmCommand.cancel();
             }
         }
     }
-*/
+
     //#region Drive Methods
 
     public void driveArm(double goalAngle) {