Updated Robot code after driver training 3/11

Updated polarity and speed of motors.  Fixed some bugs.