Tested New Teleop, and tried to fix autonomous