add pose getter

TripleHelixProgramming · Jan 25, 2025 · e6ea906 · e6ea906
1 parent a5e3ded
commit e6ea906
Showing 1 changed file with 6 additions and 0 deletions.
diff --git a/src/main/java/frc/lib/AutoSelector.java b/src/main/java/frc/lib/AutoSelector.java
@@ -113,4 +113,10 @@ public void disabledPeriodic() {
           initialPosePublisher.set(new Pose2d());
         });
   }
+
+  public Optional<Pose2d> getInitialPose() {
+    return currentAutoOption.isPresent()
+      ? currentAutoOption.get().getInitialPose()
+      : Optional.empty();
+  }
 }