LED flash command made

Merridew1 · Dec 7, 2024 · 6d66eb8 · 6d66eb8
1 parent 26bf8f0
commit 6d66eb8
Showing 1 changed file with 16 additions and 0 deletions.
diff --git a/src/main/java/frc/robot/subsystems/LEDs.java b/src/main/java/frc/robot/subsystems/LEDs.java
@@ -2,6 +2,7 @@
 
 import edu.wpi.first.wpilibj.AddressableLED;
 import edu.wpi.first.wpilibj.AddressableLEDBuffer;
+import edu.wpi.first.wpilibj.Timer;
 import edu.wpi.first.wpilibj.util.Color;
 import edu.wpi.first.wpilibj2.command.Command;
 import edu.wpi.first.wpilibj2.command.Commands;
@@ -115,6 +116,21 @@ public Command flashCommand(Color color, Color altColor) {
         return Commands.runEnd(null, null, null);
     }
 
+    public void flash(Color color, Color altColor) {
+        Timer timer = new Timer();
+        for (int i = 0; i < 3; i++) {
+            if (i % 2 == 0) {
+                setColor(color);
+                timer.start();
+            } else {
+                setColor(altColor);
+                timer.start();
+            }
+            timer.advanceIfElapsed(.25);
+            timer.reset();
+        }
+    }
+
 
 }