fix cone cube mode in alignment zone

Patribots4738 · Oct 11, 2023 · f6ab8bd · f6ab8bd
1 parent 759ad94
commit f6ab8bd
Showing 1 changed file with 4 additions and 0 deletions.
diff --git a/src/main/java/frc/robot/Robot.java b/src/main/java/frc/robot/Robot.java
@@ -613,6 +613,8 @@ else if (autoAlignment.getCurrentNorm() < (PlacementConstants.CONE_BASE_RADIUS)
 
       if (claw.hasGameElement())
         arduinoController.setLEDState(LEDConstants.BELLY_PAN_GREEN_BLINK);
+      else 
+        arduinoController.setLEDState(AutoAlignment.coneMode ? LEDConstants.BELLY_PAN_YELLOW : LEDConstants.BELLY_PAN_PURPLE);
 
       DriverUI.aligned = true;
 
@@ -622,6 +624,8 @@ else if (autoAlignment.getCurrentNorm() < (PlacementConstants.CONE_BASE_RADIUS)
 
         if (claw.hasGameElement())
           arduinoController.setLEDState(LEDConstants.BELLY_PAN_RED);
+        else 
+          arduinoController.setLEDState(AutoAlignment.coneMode ? LEDConstants.BELLY_PAN_YELLOW : LEDConstants.BELLY_PAN_PURPLE);
 
         DriverUI.aligned = false;