// **** basic switch function by Gareth
#include "oled.h"  //load the oled with Adafruit_SSD1306.h library
//############
int TN2 = 2;  //turnstile 2 on pin 2
int TN1 = 4;  //turnstile 1 on pin 4
int riders = 0; // how many people in queue

void setup() {
  setup_oled();  // Start the OLED Display
}

void loop() {

  digitalWrite(TN2, HIGH);  //
  OLED_SENSOR("WAIT ", counter());
  sdelay(1);  //run loop at max speed

  if (counter() == 0)     // open at 0 seconds
    digitalWrite(TN2, HIGH);


  if (counter() == 3)    // close at 3 seconds
    digitalWrite(TN2, LOW);


  if (counter() == 6)
    setcounter(0); //restart counter loop
  if (riders > 60) riders = riders - 60;

  if (digitalRead(A2) == LOW) {
    setcounter(-10000); // lock to -10 seconds
  }

  if (digitalRead(A0) == LOW) {
    riders = riders + 10;
    OLED_SENSOR("WAIT", riders);
    sdelay(1000);
  }
}