fixed toggle for turn to angle

Co-Authored-By: ShasshU <143851930+ShasshU@users.noreply.github.com>
nerdherd · Oct 29, 2024 · f50459d · f50459d
1 parent 625f07e
commit f50459d
Showing 1 changed file with 8 additions and 1 deletion.
diff --git a/src/main/java/frc/robot/RobotContainer.java b/src/main/java/frc/robot/RobotContainer.java
@@ -160,9 +160,16 @@ public void initDefaultCommands_teleop() {
           // }
           // SmartDashboard.putBoolean("Turn to angle 2", false);
           // return commandDriverController.getRightX(); // Rotation
-          return 0.0;
+
+          if (swerveDrive.getTurnToAngleMode()) {
+            return 0.0;
+          }
+          else {
+            return commandDriverController.getRightX();
+          }
         },
 
+
         // driverController::getSquareButton, // Field oriented
         () -> false, // should be robot oriented now on true
         () -> false,