PoseEstimator now takes in a list of PhotonPoseEstimators that are created in RobotContainer, iterates over them and applies the same estimation updates as before.
This also moves the poseEstimator.update() call from robotPeriodic to a new Notifier thread. This should help avoid loop overruns
Took Nehuels changes from MultiAprilCam branch
PoseEstimatornow takes in a list ofPhotonPoseEstimatorsthat are created inRobotContainer, iterates over them and applies the same estimation updates as before.This also moves the
poseEstimator.update()call fromrobotPeriodicto a newNotifierthread. This should help avoid loop overruns