Actual Robot Code

Needs "Sweet Spots" modified....
Robot Code 1.1

Improved Teleop and Autonomus