Add if command, and speed saving

2026-06-09 00:38:02 -06:00 · 2025-02-26 15:40:29 -07:00
parent d7765def68
commit eb5dce08df
6 changed files with 117 additions and 29 deletions
@@ -243,6 +243,14 @@ public class Elevator extends SubsystemBase {
    // }
  }

+  public boolean isL4Primed(){
+    return currentState == CoordinationState.PrimedFour;
+  }
+
+  public boolean isL3Primed(){
+    return currentState == CoordinationState.PrimedThree;
+  }
+
  public void armShuffle(){
    if(!basinBeamBreak.get()){
      //shuffle the coral with the arm until coral hits beam break