Vision things

[nancyesquivel10]

• [x] April tags update odometry
• [ ] April tags line up for placing game piece
• [ ] April tags for balancing

[J-Palomino]

What does pseudo code look like for this start there decide what logic you want to use then move to the laptop

[J-Palomino]

Great job identifying the needs here

[nancyesquivel10]

https://www.chiefdelphi.com/t/interpreting-photonvision-results/419048

[J-Palomino]

To promote stability of the pose estimate and make it robust to bad vision data, we recommend only adding vision measurements that are already within one meter or so of the current pose estimate.

[J-Palomino]

https://github.wpilib.org/allwpilib/docs/release/java/edu/wpi/first/math/estimator/DifferentialDrivePoseEstimator.html