diff --git a/lib/src/main/java/com/fairportrobotics/frc/poe/CameraTracking/RobotFieldPosition.java b/lib/src/main/java/com/fairportrobotics/frc/poe/CameraTracking/RobotFieldPosition.java index 17ed464..2c62ef5 100644 --- a/lib/src/main/java/com/fairportrobotics/frc/poe/CameraTracking/RobotFieldPosition.java +++ b/lib/src/main/java/com/fairportrobotics/frc/poe/CameraTracking/RobotFieldPosition.java @@ -30,8 +30,7 @@ public class RobotFieldPosition { photonPoseEstimator = new PhotonPoseEstimator(layout, PoseStrategy.LOWEST_AMBIGUITY, cam, robotToCam); } - public Optional getEstimatedGlobalPose(Pose2d prevEstimatedRobotPose) { - photonPoseEstimator.setReferencePose(prevEstimatedRobotPose); + public Optional getEstimatedGlobalPose() { return photonPoseEstimator.update(); }