#include <SPI.h>
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#include "EEPROM.h"
#define EEPROM_SIZE 1000

#define SW10 5
#define SW15 17
#define SW14 16
#define LED 25
#define POT 34
#define OnboardLED 2
#define IDNisit 139

#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64

Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire);

long lasttime1sec = 0;
long lasttime500ms = 0;
char tempstring[100];
bool toogle = true;
const int ledPin = 25;
const int freq = 5000;
const int ledChannel = 0;
const int resolution = 8;
int adcvalue = 0;
int mode = 0;
int adcRT = 0;
int var0, var1;
int address = 0;
int ledpot= 0;
int led15 = 0;
int led14 = 0;
int ledformat = 0;

void setup() {
  Serial.begin(115200);
  if (!display.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
    Serial.println(F("SSD1306 allocation failed"));
  }

  if (!EEPROM.begin(EEPROM_SIZE)) {
    Serial.println("Failed init EEPROM");
    delay(1000);
    ESP.restart();
  }
  Serial.println("Success init EEPROM");

  pinMode(SW10, INPUT_PULLUP);
  pinMode(SW15, INPUT_PULLUP);
  pinMode(SW14, INPUT_PULLUP);
  pinMode(OnboardLED, OUTPUT);
  

  //display.display();
  delay(2000);
  display.clearDisplay();
  // Test Draw Char
  display.setTextSize(2);
  display.setTextColor(WHITE);
  display.setCursor(0, 0);
  display.println(F("HELLO"));
  display.setCursor(0, 15);
  display.println(F("ESP32"));
  display.display();
  delay(2000);

  ledcSetup(ledChannel, freq, resolution);
  ledcAttachPin(ledPin, ledChannel);
}
void loop() {

  adcvalue = analogRead(POT);
  adcRT = (adcvalue * 255/4095);
  if (digitalRead(SW10) == LOW){
    EEPROM.writeUChar(address,adcvalue);
    EEPROM.commit();
    Serial.println(EEPROM.readUChar(address));
    ledpot = adcvalue;
    if(address == 242){
      led14 = adcvalue;
    }
    if(address == 0){
      led15 = adcvalue;
    }
  }
  if (digitalRead(SW15) == LOW){
    address = 0 ;
    Serial.println(EEPROM.readUChar(0));
    ledcWrite(ledChannel,led15);
    
  }
  if (digitalRead(SW14) == LOW){
    address = 242;
    Serial.println(EEPROM.readUChar(242));
    ledcWrite(ledChannel,led14);
  }
  if(digitalRead(SW15)== LOW){
      ledformat=led15;
  }
  if(digitalRead(SW14)== LOW){
      ledformat=led14;
  }

  if (millis() - lasttime1sec >= 1000) {
    lasttime1sec = millis();

    // Display
    display.clearDisplay();
    display.setTextSize(1);
    display.setCursor(0, 0);
    sprintf(tempstring, "EEPROM   ADC %d", adcvalue);
    display.print(tempstring);
    Serial.println(tempstring);
    display.setCursor(0, 10);
    sprintf(tempstring, "Address: %d (%x)", address,address);
    display.print(tempstring);
    Serial.println(tempstring);
    display.setCursor(0, 20);
    sprintf(tempstring, "Data: %d", ledformat/16);
    display.print(tempstring);
    Serial.println(tempstring);
    display.display();

  }
 
}