finished test program but it doesn't work with the smartdashboard or robot yet, also removed some working files