update Estimated Std Devs
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
estimated Pose
The estimated robot pose to use for updating the standard deviations.
targets
The list of tracked targets to use for updating the standard deviations.
single Target Vector
The standard deviations for a single target.
multi Target Vector
The standard deviations for multiple targets.