-Changed SmartDashboard varible names
-Adjusted contasts
-Changed inversion