Add RobotPoseEstimator (#571)

RobotPoseEstimator can pick the most likely pose for the robot given a number of possible poses, using a number of different strategies. Examples are still WIP.
2026-06-19 00:41:41 +00:00 · 2022-12-30 00:40:13 -06:00
parent 3a10f49b54
commit 550194152a
12 changed files with 1805 additions and 4 deletions
--- a/photon-lib/src/main/native/cpp/photonlib/PhotonCamera.cpp
+++ b/photon-lib/src/main/native/cpp/photonlib/PhotonCamera.cpp
@@ -61,6 +61,7 @@ PhotonCamera::PhotonCamera(const std::string_view cameraName)
                   cameraName) {}

 PhotonPipelineResult PhotonCamera::GetLatestResult() {
+  if (test) return testResult;
  // Prints warning if not connected
  VerifyVersion();