#include <Adafruit_SSD1306.h>
#include <Adafruit_GFX.h>
Adafruit_SSD1306 pantalla(128,64,&Wire,-1);
#define boton1 8
#define boton2 9
#define boton3 10
int menuSeleccion =1;
int pantallaActiva=1;
void setup() {
  pinMode(boton1, INPUT);
  pinMode(boton2, INPUT);
  pinMode(boton3, INPUT);
  pantalla.begin(SSD1306_SWITCHCAPVCC, 0x3C);
  pantalla.clearDisplay();
  pantalla.setTextSize(1);
  pantalla.setTextColor(SSD1306_WHITE);
  pantalla.display();
}

void loop() {
  if (digitalRead(boton3)){
    menuSeleccion++;
    delay(100);
  }
  if (digitalRead(boton1)){
    menuSeleccion--;
    delay(100);
  }
  if (digitalRead(boton2) && pantallaActiva==1){
      pantallaActiva=menuSeleccion+1;
    delay(100);
  }
  if (digitalRead(boton2) && pantallaActiva!=1){
      pantallaActiva=1;
    delay(100);
  }
  if (pantallaActiva==1){
    menuPrincipal();
    seleccion();
  }
  if (pantallaActiva==2){
    pantalla1();
  }
  if (pantallaActiva==3){
    pantalla2();
  }
  if (pantallaActiva==4){
    pantalla3();
  }
}
void menuPrincipal(){
  pantalla.clearDisplay();
  pantalla.setTextColor(SSD1306_WHITE);
  pantalla.setTextSize(1);
  pantalla.setCursor(7, 7); 
  pantalla.print("Menu 1");
  pantalla.setCursor(7, 20); 
  pantalla.print("Menu 2");
  pantalla.setCursor(7, 32); 
  pantalla.print("Menu 3");
  pantalla.display();
}
void seleccion(){
  if (menuSeleccion<1){
    menuSeleccion=3;
  }
  if (menuSeleccion>3){
    menuSeleccion=1;
  }
  if (menuSeleccion==1){
    pantalla.setTextColor(SSD1306_WHITE);
    pantalla.drawRect(3,3,43,15,SSD1306_WHITE);
  }
  if (menuSeleccion==2){
    pantalla.setTextColor(SSD1306_WHITE);
    pantalla.drawRect(3,15,43,15,SSD1306_WHITE);
  }
  if (menuSeleccion==3){
    pantalla.setTextColor(SSD1306_WHITE);
    pantalla.drawRect(3,28,43,15,SSD1306_WHITE);
  }
  pantalla.display();
}
void pantalla1(){
  pantalla.clearDisplay();
  pantalla.setTextColor(SSD1306_WHITE);
  pantalla.setTextSize(1);
  pantalla.setCursor(7, 7); 
  pantalla.print("DHT");
  pantalla.display();
}
void pantalla2(){
  pantalla.clearDisplay();
  pantalla.setTextColor(SSD1306_WHITE);
  pantalla.setTextSize(1);
  pantalla.setCursor(7, 7); 
  pantalla.print("Servo");
  pantalla.display();
}
void pantalla3(){
  pantalla.clearDisplay();
  pantalla.setTextColor(SSD1306_WHITE);
  pantalla.setTextSize(1);
  pantalla.setCursor(7, 7); 
  pantalla.print("LEDS");
  pantalla.display();
}