meow

WindowsVistaisCool · Nov 1, 2024 · 427173e · 427173e
1 parent 0f508dd
commit 427173e
Show file tree

Hide file tree

Showing 2 changed files with 12 additions and 3 deletions.
diff --git a/src/main/java/frc/robot/commands/EnableRobot.java b/src/main/java/frc/robot/commands/EnableRobot.java
@@ -46,7 +46,8 @@ public void initialize() {
         readyToEnable = true;
         hasEnabled = true;
 
-        // buttons.setEnableState(false);
+        buttons.setAllLow();
+        buttons.setLock(false);
     }
 
     @Override
@@ -59,6 +60,7 @@ public void end(boolean interrupted) {
             if (!DriverStation.isEnabled()) {
                 led.set(new Solid(RGBConstruct.RED)).schedule();
             }
+            buttons.setLock(true);
         }).schedule();
     }
 

diff --git a/src/main/java/frc/robot/subsystems/ButtonControl.java b/src/main/java/frc/robot/subsystems/ButtonControl.java
@@ -60,8 +60,15 @@ public boolean getEnableState() {
         return buttonsEnabled;
     }
 
-    public void setEnableState(boolean state) {
-        buttonsEnabled = state;
+    public void setAllLow() {
+        red.setOverrideState(ButtonOverrideState.OVERRIDE_LOW);
+        yellow.setOverrideState(ButtonOverrideState.OVERRIDE_LOW);
+        green.setOverrideState(ButtonOverrideState.OVERRIDE_LOW);
+        greenTop.setOverrideState(ButtonOverrideState.OVERRIDE_LOW);
+    }
+
+    public void setLock(boolean lockEnabled) {
+        buttonsEnabled = !lockEnabled;
 
         if (buttonsEnabled) {
             red.setOverrideState(ButtonOverrideState.NORMAL);