updateEstimatedStdDevs

fun updateEstimatedStdDevs(estimatedPose: Optional<EstimatedRobotPose>, targets: List<PhotonTrackedTarget>, singleTargetVector: Matrix<N3, N1> = DEFAULT_SINGLE_TARGET_STD_DEVS_2D, multiTargetVector: Matrix<N3, N1> = DEFAULT_MULTI_TARGET_STD_DEVS_2D)

Updates the estimated standard deviations based on the provided estimated pose and targets.

Parameters

estimatedPose

The estimated robot pose to use for updating the standard deviations.

targets

The list of tracked targets to use for updating the standard deviations.

singleTargetVector

The standard deviations for a single target.

multiTargetVector

The standard deviations for multiple targets.