#include <Wire.h>
#include <Adafruit_SSD1306.h>
#include <MemoryUsage.h>


#define SCREEN_WIDTH 128
#define SCREEN_HEIGHT 64

#define OLED_RESET     4
Adafruit_SSD1306 display(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, OLED_RESET);






void setup() {
  Serial.begin(9600);
  Serial.println(F("Serial started"));

  if(!display.begin(SSD1306_SWITCHCAPVCC, 0x3D)) { // Address 0x3D for 128x64
    Serial.println(F("SSD1306 allocation failed"));
    for(;;); // Don't proceed, loop forever
  }


  // String MenuLevel1_names[10];

MEMORY_PRINT_START
    MEMORY_PRINT_HEAPSTART
    MEMORY_PRINT_HEAPEND
    MEMORY_PRINT_STACKSTART
    MEMORY_PRINT_END
    MEMORY_PRINT_HEAPSIZE

    Serial.println();
    Serial.println();
   
    FREERAM_PRINT;

    byte *p = new byte[3000];    
    
    Serial.println();
    Serial.println();
    
    Serial.println(F("Ending state of the memory:"));
    Serial.println();
    
    MEMORY_PRINT_START
    MEMORY_PRINT_HEAPSTART
    MEMORY_PRINT_HEAPEND
    MEMORY_PRINT_STACKSTART
    MEMORY_PRINT_END
    MEMORY_PRINT_HEAPSIZE
    
    Serial.println();
    Serial.println();
    
    FREERAM_PRINT;
  // Clear the buffer
  display.clearDisplay();
}

void loop() {
  menu();
  delay(1000);
  menu2();
  delay(1000);
  menuPowerOff();
}


void menu(void) {
  display.clearDisplay();

  display.setCursor(0,0);             // Start at top-left corner

  display.setTextSize(1);             // Draw 2X-scale text
  display.setTextColor(BLACK, WHITE);
  display.println(F("    --=IOT Menu=--   ")); 
  // display.println(0xDEADBEEF, HEX);

  display.setCursor(0,12);             // Start at top-left corner

  display.setTextSize(1);             // Normal 1:1 pixel scale
  display.setTextColor(WHITE);        // Draw white text
  display.println(F("  PWM 01"));
  display.println(F("> PWM 02"));
  display.println(F("  PWM 03"));
  display.println(F("  Relay 01"));
  display.println(F("  Relay 02"));
  display.println(F("  Relay 03"));
  display.display();
}


void menu2(void) {
  display.clearDisplay();

  display.setCursor(0,0);             // Start at top-left corner

  display.setTextSize(1);             // Draw 2X-scale text
  display.setTextColor(BLACK, WHITE);
  display.println(F("      --=PWM02=--    ")); 
  // display.println(0xDEADBEEF, HEX);

  display.setCursor(0,12);             // Start at top-left corner

  display.setTextSize(1);             // Normal 1:1 pixel scale
  display.setTextColor(WHITE);        // Draw white text
  display.println(F("  Toggle"));
  display.println(F("  Off"));
  display.println(F("> On"));
  display.println(F("  Set value"));
  display.println(F("  Play custom"));
  display.println(F("  Flicker"));
  display.display();
}


void menuPowerOff(void) {
  display.clearDisplay();

  display.setCursor(10,26);             // Start at top-left corner
  display.setTextSize(2);             // Draw 2X-scale text
  display.setTextColor(WHITE);
  display.println(F("POWER OFF")); 
  display.display();
  
  delay(1000);
  display.clearDisplay();
  display.display();
  delay(1000);
}