fixed toggle for turn to angle

Co-Authored-By: ShasshU <[email protected]>

Author: silverx257

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,