A rewrite of my previous VisionTracking code, updated to utilize FRC robot libraries