TrackTimer.ino

#include <SPI.h>
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306_STM32.h>

#define OLED_RESET 4
Adafruit_SSD1306 display(OLED_RESET);


int LED = PC13;
int track1 = PA3;
int track2 = PB11;
int gate = PC14;

volatile int track1State;
volatile int track2State;
volatile int gateState;
volatile int raceState;
volatile int TOTtripped;
static unsigned long TOTmax = 30000; // If you cant make it down the track in 30 seconds, something is broke.
volatile unsigned long TOT; // time out timer
volatile unsigned long startTime = 3;
volatile unsigned long track1Time = 3;
volatile unsigned long track2Time = 3;

void setup() {
  

  Serial.begin(115200); // init the serial
 /* // this is for debugging only.  It will stop the uC if there isnt something watching the serial port 
    while (!Serial) {
    ; // wait for serial port to connect. Needed for native USB
  }
  */
  Serial.println("https://github.com/yNosGR/TrackTimer");
  //init and setup the display
  display.begin(SSD1306_SWITCHCAPVCC, 0X3c);
  display.clearDisplay();
  display.setTextColor(WHITE);
  display.setTextSize(1);
  display.setRotation(2); // to rotate 180 degrees, uncomment this line
  display.setCursor(0,1);
  display.print("Ready!");
  display.setCursor(0,40);

  display.display();
  
  // set out outputs
  pinMode(LED, OUTPUT); // set the LED pin to an output
  // set our inputs
  pinMode(track1,INPUT_PULLUP);
  attachInterrupt(track1, track1Event, FALLING);
  pinMode(track2,INPUT_PULLUP);
  attachInterrupt(track2, track2Event, FALLING);
  pinMode(gate,INPUT_PULLUP);
  attachInterrupt(gate, gateDrop, FALLING);
  

}
void gateDrop(){
  startTime = millis();
  track1Time = 0;
  track2Time = 0;
  track1State = 0;
  track2State = 0;
  gateState = 0; 
  raceState = 1;
  TOTtripped = 0; 
  Serial.println("Go!");
  display.clearDisplay();
  display.setCursor(0,0);
  display.println("Go!");
  display.display();
  
}

void track1Event() {
 track1Time = millis()-startTime;
 track1State = 1;
}

void track2Event() {
 track2Time = millis()-startTime;
 track2State = 1;
}

void loop() {
  while (track1Time == 0 && track2Time == 0) {
    display.clearDisplay();
    display.setCursor(0,0);
    display.println("Gate Dropped");
    delay(100);
    digitalWrite(LED, !digitalRead(LED));
    //Serial.print(digitalRead(track1));Serial.print(","); Serial.print(digitalRead(track2));Serial.print(","); Serial.println(digitalRead(gate));
    //Serial.print(track1Time);Serial.print(","); Serial.print(track2Time);Serial.print(","); Serial.println(startTime);
  }
  while ((!track1Time == 0 || !track2Time == 0) && (track1State != track2State) && !TOTtripped) {
    raceState = 1;
    TOT = millis() - startTime;
    if (track1Time == 0 && TOT <= TOTmax){
      Serial.print("Track 2 Wins!: ");
      Serial.println(track2Time);
      Serial.print(digitalRead(track1));Serial.print(","); Serial.print(digitalRead(track2));Serial.print(","); Serial.println(digitalRead(gate));
      display.clearDisplay();
      display.setCursor(0,40);
      display.println("Track 2 wins!");
      display.print("Time:  "); display.print(track2Time/1000);display.print(".");display.print(track2Time%1000);
      display.display();
      
      delay(150);
    }
    if (track2Time == 0 && TOT <= TOTmax){
      TOT = millis() - startTime;
      Serial.print("Track 1 Wins!: ");
      Serial.println(track1Time);
      Serial.print(digitalRead(track1));Serial.print(","); Serial.print(digitalRead(track2));Serial.print(","); Serial.println(digitalRead(gate));
      TOT++;
      display.clearDisplay();
      display.setCursor(0,0);
      display.println("Track 1 wins!");
      display.print("Time:  "); display.print(track1Time/1000);display.print("."); display.print(track1Time%1000);
      display.display();
      
      delay(150);
    }
    while (TOT >= TOTmax){
      if (!TOTtripped){
        Serial.println("Timeout!");
        TOTtripped = 1 ;
      }
    }
  } 
  while (raceState == 1) {
    if (track1Time<track2Time){
      Serial.println("Display Finish Stats");
      display.clearDisplay();
      display.setCursor(0,0);
      display.println("Track 1 wins!");
      display.print("Time:  "); display.print(track1Time/1000);display.print("."); display.print(track1Time%1000);
      display.setCursor(0,40);
      display.println("Track 2");
      display.print("Time:  "); display.print(track2Time/1000);display.print("."); display.print(track2Time%1000);
      display.display();     
      
    }
    if (track1Time>track2Time){
      Serial.println("Display Finish Stats");
      display.clearDisplay();
      display.setCursor(0,0);
      display.println("Track 1");
      display.print("Time:  "); display.print(track1Time/1000);display.print("."); display.print(track1Time%1000);
      display.setCursor(0,40);
      display.println("Track 2 wins!");
      display.print("Time:  "); display.print(track2Time/1000);display.print("."); display.print(track2Time%1000);
      display.display();     
      
    }
    Serial.println("Reset raceState");
    raceState = 0;
  }
  
}