Pre-York First commit

Teleop and autonomouses. Wiring configs back to normal