Fixed auto2, forgot to reenable though. Added vision data parse
Added hot goal determining code, auton2 now waits for hot.