Lots of things

Conner edited teleop, Stephien edited autonomous.
Added commented out code for checking distance