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/include/photonlib/SimVisionSystem.h
+++ b/photon-lib/src/main/native/include/photonlib/SimVisionSystem.h
@@ -181,6 +181,10 @@ class SimVisionSystem {
                                0.0,
                                target.targetId,
                                camToTargetTransform,
+                                // TODO sim alternate pose
+                                camToTargetTransform,
+                                // TODO ambiguity
+                                0.0,
                                {{0, 0}, {0, 0}, {0, 0}, {0, 0}}});
      }