updateEstimatedStdDevs3d

fun updateEstimatedStdDevs3d(estimatedPose: Optional<EstimatedRobotPose>, targets: List<PhotonTrackedTarget>, singleTargetVector: Matrix<N4, N1> = DEFAULT_SINGLE_TARGET_STD_DEVS_3D, multiTargetVector: Matrix<N4, N1> = DEFAULT_MULTI_TARGET_STD_DEVS_3D)

Updates the estimated 3D standard deviations.

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.