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

#include "sketch.h"

void setup() {
  
  Serial.begin(9600);

  // Configure PINs direction
  pinMode(PROGRAM_LED_PIN, OUTPUT);
  pinMode(BTN_PROGRAM_PIN, INPUT_PULLUP);
  pinMode(BTN_DOWN_PIN, INPUT_PULLUP);
  pinMode(BTN_UP_PIN, INPUT_PULLUP);
  
  if(!display.begin(SSD1306_SWITCHCAPVCC, SCREEN_ADDRESS)) {
    Serial.println(F("SSD1306 allocation failed"));
    for(;;); 
  }

  // Program mode is disabled at start
  toggleProgramMode(); 

  for(int i = 0; i < 16; i++) {
    outputs[i][0] = 1;
    outputs[i][1] = 100;
    outputs[i][2] = 20;
  } 
}

void loop() {

  checkButtons();
}