diff --git a/src/main/java/com/techhounds/houndutil/houndlib/AprilTagPhotonCamera.java b/src/main/java/com/techhounds/houndutil/houndlib/AprilTagPhotonCamera.java index 6e19c3f..d612fe9 100644 --- a/src/main/java/com/techhounds/houndutil/houndlib/AprilTagPhotonCamera.java +++ b/src/main/java/com/techhounds/houndutil/houndlib/AprilTagPhotonCamera.java @@ -56,7 +56,7 @@ public Optional getEstimatedGlobalPose( PhotonPipelineResult result = photonCamera.getLatestResult(); result.targets.removeIf((target) -> target.getPoseAmbiguity() > 0.2); result.targets.removeIf((target) -> target.getFiducialId() > 8); - result.targets.removeIf((target) -> target.getBestCameraToTarget().getTranslation().getNorm() > 2); + result.targets.removeIf((target) -> target.getBestCameraToTarget().getTranslation().getNorm() > 4); photonPoseEstimator.setReferencePose(prevEstimatedRobotPose); Optional estimatedRobotPose = photonPoseEstimator.update(result);