Autonomous/Teleop

Added Autonomous and Teleop Code