Added variables and an empty function for Teleop Driving
Organized. Added code to drive robot in tankdrive. Started code for shifters. End of day 1