[TASK] Tune Vision Filtering

[skrunked]

Description:

New AdvantageKit Vision system was implemented in #77, however, it was left relatively stock. Please tune the filtering (standard deviation, ambiguity thresholds, new custom filters, et cetera) to make pose estimates more stable and eliminate bad estimates.

Category:

• Documentation
• Refactoring / Cleanup
• Testing
• Tuning/Calibration
• Setup / Configuration
• Other:

---

Urgency

• Nice to Have
• Important
• Critical

Impacted Modes:

• Disabled
• Teleop
• Auto
• Simulation

Impacted Systems:

• Drive
• Vision
• Autonomous
• Logging
• Mechanism(s)

When?

• Periodic
• Init
• Command

File(s) of Focus:

Vision.java
VisionConstants.java

Resources:

---

Screenshots/GIFs/Videos: