Removed an unnecessary method from IAprilTagProvider, and modified some stuff that used it so that things make more sense

This commit is contained in:
2024-01-15 16:29:00 -05:00
parent 477f066585
commit dd39baf182
4 changed files with 24 additions and 42 deletions

View File

@@ -78,27 +78,6 @@ public class PhotonVision implements ICamera,IAprilTagProvider,IVisualPoseProvid
);
}
@Override
public OptionalDouble getTagOffsetFromCameraCenterByID(int id, double cameraHalfXRes) {
PhotonPipelineResult result = camera.getLatestResult();
if (!result.hasTargets()) {
return OptionalDouble.empty();
}
Optional<PhotonTrackedTarget> desiredTarget = getTargetFromList(result.getTargets(), id);
if (desiredTarget.isEmpty()) {
return OptionalDouble.empty();
}
List<TargetCorner> corners = desiredTarget.get().getDetectedCorners();
return OptionalDouble.of(
corners.get(2).x - corners.get(3).x - cameraHalfXRes
);
}
@Override
public OptionalDouble getTagDistanceFromCameraByID(int id, double targetHeightMeters) {
PhotonPipelineResult result = camera.getLatestResult();