Added autonomous/teleop switch in interrupt 2, pin 21