made proggress in knowing what subdivisions to make. also made initial color decisions

Author: PotatoBoyH4

src/main/java/frc/robot/constants/LEDConstants.java

@@ -1,3 +1,26 @@
 package frc.robot.constants;
 
-public class LEDConstants {}
+import edu.wpi.first.wpilibj.util.Color;
+
+public class LEDConstants {
+    public static final int stripLength = 42;
+
+    public static final Color kAlmostBlack = new Color(0, 0, 1);
+    // LED Colors
+    public static final Color kHasAlgea = Color.kAquamarine;
+    public static final Color kNotHasAlgea = kAlmostBlack;
+    public static final Color kCoralNotInRobot = Color.kOrange;
+    public static final Color kCoralInFunnel = Color.kHotPink;
+    public static final Color kCoralInRobot = Color.kWhite;
+    public static final Color kCurrentLimiting = Color.kRed;
+    public static final Color kAutoPlacing = Color.kPurple;
+    public static final Color kManual = kAlmostBlack;
+    public static final Color kRight = Color.kSaddleBrown;
+    public static final Color kLeft = Color.kGreenYellow;
+    public static final Color kL1 = Color.kBlue;
+    public static final Color kL2 = Color.kGreen;
+    public static final Color kL3 = Color.kYellow;
+    public static final Color kL4 = Color.kRed;
+    public static final Color kGettingAlgea = Color.kAquamarine;
+    public static final Color kNotGettingAlgea = kAlmostBlack;
+}

src/main/java/frc/robot/subsystems/led/LEDIO.java

@@ -51,9 +51,17 @@ public void setOff() {
     for (int i = 0; i < led.getLength(); i++) {
       setLED(i, Color.kBlack);
     }
+    ledBase.setData(led);
   }
 
   public void setStrip(LEDPattern pattern) {
     pattern.applyTo(led);
   }
+
+  public void setStrip(Color color) {
+    for (int i = 0; i < led.getLength(); i++) {
+      setLED(i, color);
+    }
+    ledBase.setData(led);
+  }
 }

src/main/java/frc/robot/subsystems/led/LEDSubsystem.java

@@ -2,18 +2,24 @@
 
 import static edu.wpi.first.units.Units.Seconds;
 
+import java.util.Map;
 import java.util.Set;
 
 import org.strykeforce.telemetry.measurable.MeasurableSubsystem;
 import org.strykeforce.telemetry.measurable.Measure;
 
 import edu.wpi.first.wpilibj.LEDPattern;
 import edu.wpi.first.wpilibj.util.Color;
+import frc.robot.constants.LEDConstants;
 
 public class LEDSubsystem extends MeasurableSubsystem{
     private LEDIO io;
-    private LEDPattern base = LEDPattern.steps(map.of(0, Color.kAqua, ));
-    LEDPattern red = LEDPattern.solid(Color.kRed);
+    private LEDPattern base = LEDPattern.solid(Color.kBlack);
+    private LEDPattern coral = LEDPattern.solid(LEDConstants.kCoralInRobot);
+    private LEDPattern algea = LEDPattern.steps(Map.of(0, LEDConstants.kHasAlgea, LEDConstants.stripLength/3, Color.kBlack));
+
+    private LEDPattern currentLimiting = LEDPattern.solid(LEDConstants.kCurrentLimiting).blink(Seconds.of(1), Seconds.of(2));
+    private LEDPattern autoplace = LEDPattern.steps(Map.of(LEDConstants.stripLength/3*2, LEDConstants.kAutoPlacing)).blink(Seconds.of(0.25));
     public LEDStates currState = LEDStates.OFF;
     public CoralStates coralState = CoralStates.NO_PIECE; 
     public boolean autoPlacing = false;
@@ -22,15 +28,41 @@ public class LEDSubsystem extends MeasurableSubsystem{
 
     public LEDSubsystem(LEDIO io) {
         this.io = io;
-        red.blink(Seconds.of(1), Seconds.of(2));
+    }
+
+    private void buildBase() {
+        switch (coralState) {
+            case IN_FUNNEL:
+                coral = LEDPattern.solid(LEDConstants.kCoralInFunnel);
+                break;
+            case IN_ROBOT:
+                coral = LEDPattern.solid(LEDConstants.kCoralInRobot);
+                break;
+            case NO_PIECE:
+                coral = LEDPattern.solid(LEDConstants.kCoralNotInRobot);
+                break;
+        }
+        algea = LEDPattern.steps(Map.of(0, LEDConstants.kHasAlgea, LEDConstants.stripLength/3, Color.kBlack));
 
     }
 
     public void periodic() {
-        red.blink(Seconds.of(1), Seconds.of(2));
-        if (isLimiting) {
-            red.overlayOn(base);
+        switch (currState) {
+            case OFF:
+                break;
+            case NORMAL:
+                if (autoPlacing) {
+                    base = autoplace.overlayOn(base);
+                }
+                if (isLimiting) {
+                    base = currentLimiting.overlayOn(base);
+                }
+                io.setStrip(base);
+                break;
+            case CLIMB:
+                break;
         }
+        io.updateLEDs();
     }
 
     @Override
@@ -46,8 +78,8 @@ public enum LEDStates {
     }
 
     public enum CoralStates {
-        HAS_PIECE,
-        IN_MECH,
+        IN_FUNNEL,
+        IN_ROBOT,
         NO_PIECE,
     }
 }