#include <Wire.h>
#include <Adafruit_SSD1306.h>
#include <Adafruit_GFX.h>
#include "displaymodes.h"

// OLED display TWI address
#define OLED_ADDR   0x3C

// reset pin not used on 4-pin OLED module
Adafruit_SSD1306 display;
void setup() {
  Wire.setClock(1000000);
  display = Adafruit_SSD1306(128,64);
  // initialize and clear display
  display.begin(SSD1306_SWITCHCAPVCC, OLED_ADDR);
  display.clearDisplay();
  display.display();

  // Draw the top bar
  display.drawRect(0,0,128,16,WHITE);

  // display a line of text
  display.setTextSize(1);
  display.setTextColor(WHITE);
  display.setCursor(27,30);
  display.print("Hello, world!");

  // display a line of text
  display.setTextSize(1);
  display.setTextColor(BLACK);
  display.setCursor(4,4);
  display.print("BACK");

  //Rect
  

  // update display with all of the above graphics
  display.display();
  
}

int xpos = 0;
int ypos = 0;
long millislast = 0;
long milliscurr = 0;
void loop() {
  // put your main code here, to run repeatedly:
  display.clearDisplay();
  //Draw a line
  
  //display.startWrite();
  display_waveform_select(display);
  //display.endWrite();

  ///*
  //display.clearDisplay();
  millislast = milliscurr;
  milliscurr = millis();
  display.writeFillRect(110,2,12,8,BLACK);
  display.setTextSize(1);
  display.setTextColor(WHITE);
  display.setCursor(110,2);
  display.print(milliscurr-millislast);
  //*/
  
  display.display();

  
}