 #include <LowPower_Teensy3.h>
 #include <FiniteStateMachine.h>
 
+// SPI Pins
 #define OLED_MOSI 11
 #define OLED_CLK 13
 #define OLED_CS 10
 #define OLED_DC 3
 #define OLED_RESET 2
 
+// Timer IDs
 #define GET_FIX_TIMER 1
 #define READ_LOCATION_TIMER 2
 
+// Index Labels
 #define LAT_INDEX 0
 #define LNG_INDEX 1
 

void updateWakeModules() {
  if(awake.isUpdated()) {
    awake.value();
    delay(1000);
    stateMachine.transitionTo(GetFix);
  }
}

void enterNextWaypoint() {
  drawTitle(F("Waypoint Reached"));
  oled.setFont(ucg_font_fixed_v0r);

  oled.setColor(255, 255, 0);
  oled.setPrintPos(0, oled.getHeight() / 2);

void loop() {
  while(Serial3.available()) gps << Serial3.read();
  TimedEvent.loop();
  button.process();
  stateMachine.update();
}
