update
public void updateEstimatedStdDevs(Optional<EstimatedRobotPose> estimatedPose, List<PhotonTrackedTarget> targets)
Updates the estimated standard deviations based on the provided estimated pose and list of tracked targets.
This method calculates the number of visible tags and their average distance to the estimated pose. It then uses this information to adjust the standard deviations used for robot pose estimation.
Parameters
estimated
An Optional containing the estimated robot pose.
targets
A list of PhotonTrackedTarget objects representing the tracked targets.