[FEATURE] Add a buffered vision pose estimator

**Is your feature request related to a problem? Please describe.**
Add a buffered vision pose estimator that is robust against errant vision measurements.

**Describe the solution you'd like**
Include Kalman filtering based on uncertainties and use a buffered approach to identify and clip outliers.
