From b3cbc5d5c8a08af500bf4f8c3e84e48b19efbcfc Mon Sep 17 00:00:00 2001
From: Wesley28w <wesleycwong@gmail.com>
Date: Tue, 3 Mar 2026 10:18:23 -0800
Subject: [PATCH] Spindexer toggle

---
 .../robot/controls/PS5ControllerDriverConfig.java   | 13 +++++++++++--
 1 file changed, 11 insertions(+), 2 deletions(-)

diff --git a/src/main/java/frc/robot/controls/PS5ControllerDriverConfig.java b/src/main/java/frc/robot/controls/PS5ControllerDriverConfig.java
index 216bce9..cd4a593 100644
--- a/src/main/java/frc/robot/controls/PS5ControllerDriverConfig.java
+++ b/src/main/java/frc/robot/controls/PS5ControllerDriverConfig.java
@@ -37,6 +37,7 @@ public class PS5ControllerDriverConfig extends BaseDriverConfig {
     private final PS5Controller controller = new PS5Controller(Constants.DRIVER_JOY);
     private final BooleanSupplier slowModeSupplier = () -> false;
     private boolean intakeBoolean = true;
+    private boolean spindexerBoolean = false;
     private Command autoShoot = null;
     private Shooter shooter;
     private Turret turret;
@@ -138,8 +139,16 @@ public class PS5ControllerDriverConfig extends BaseDriverConfig {
 
         // Spindexer
         if (spindexer != null) {
-            // Will only run if we are not calling default shoot command
-            controller.get(PS5Button.LEFT_TRIGGER).whileTrue(new RunSpindexer(spindexer, turret));
+            // Toggle spindexer
+            controller.get(PS5Button.LEFT_TRIGGER).onTrue(new InstantCommand(() -> {
+                if (spindexerBoolean) {
+                    spindexer.maxSpindexer();
+                    intakeBoolean = false;
+                } else {
+                    spindexer.stopSpindexer();
+                    intakeBoolean = true;
+                }
+            }));
         }
 
         // Auto shoot
-- 
2.39.5