VIsion Tracking final, auto commands, changed SmartDashboard

we worked on this, Issac and I