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

#define SCREEN_WIDTH 128 // OLED display width,  in pixels
#define SCREEN_HEIGHT 64 // OLED display height, in pixels

// declare an SSD1306 display object connected to I2C
Adafruit_SSD1306 oled(SCREEN_WIDTH, SCREEN_HEIGHT, &Wire, -1);

  
// Radio Buttons!
const int led1Pin =  2;    // LED pin number
const int btn1 =  A0;
const int led2Pin =  3;
const int btn2 =  A1;
const int led3Pin =  4;
const int btn3 =  A2;
const int led4Pin =  5;
const int btn4 =  A3;

char bstate1 = 0;
char bstate2 = 0;
char bstate3 = 0;
char bstate4 = 0;
unsigned long bcount1 = 0; // button debounce timer.  Replicate as necessary.
unsigned long bcount2 = 0;
unsigned long bcount3 = 0;
unsigned long bcount4 = 0;


// Have we completed the specified interval since last confirmed event?
// "marker" chooses which counter to check
// Routines by Paul__B of Arduino Forum
boolean timeout(unsigned long *marker, unsigned long interval) {
  if (millis() - *marker >= interval) {
    *marker += interval;    // move on ready for next interval
    return true;
  }
  else return false;
}

// Deal with a button read; true if button pressed and debounced is a new event
// Uses reading of button input, debounce store, state store and debounce interval.
// Routines by Paul__B of Arduino Forum
boolean butndown(char button, unsigned long *marker, char *butnstate, unsigned long interval) {
  switch (*butnstate) {               // Odd states if was pressed, >= 2 if debounce in progress
    case 0: // Button up so far,
      if (button == HIGH) return false; // Nothing happening!
      else {
        *butnstate = 2;                 // record that is now pressed
        *marker = millis();             // note when was pressed
        return false;                   // and move on
      }

    case 1: // Button down so far,
      if (button == LOW) return false; // Nothing happening!
      else {
        *butnstate = 3;                 // record that is now released
        *marker = millis();             // note when was released
        return false;                   // and move on
      }

    case 2: // Button was up, now down.
      if (button == HIGH) {
        *butnstate = 0;                 // no, not debounced; revert the state
        return false;                   // False alarm!
      }
      else {
        if (millis() - *marker >= interval) {
          *butnstate = 1;               // jackpot!  update the state
          return true;                  // because we have the desired event!
        }
        else
          return false;                 // not done yet; just move on
      }

    case 3: // Button was down, now up.
      if (button == LOW) {
        *butnstate = 1;                 // no, not debounced; revert the state
        return false;                   // False alarm!
      }
      else {
        if (millis() - *marker >= interval) {
          *butnstate = 0;               // Debounced; update the state
          return false;                 // but it is not the event we want
        }
        else
          return false;                 // not done yet; just move on
      }
    default:                            // Error; recover anyway
      {
        *butnstate = 0;
        return false;                   // Definitely false!
      }
  }
}

// button 5 
int led5 = 6;
int btn5 = 12;

bool toggle1=false;

// button 6 
int led6 = 7;
int btn6 = 13;


bool toggle2=false;


void setup()
{
  pinMode(led1Pin, OUTPUT);
  pinMode(btn1, INPUT);
  pinMode(led2Pin, OUTPUT);
  pinMode(btn2, INPUT);
  pinMode(led3Pin, OUTPUT);
  pinMode(btn3, INPUT);
  pinMode(led4Pin, OUTPUT);
  pinMode(btn4, INPUT);
  digitalWrite (led1Pin, LOW);
  digitalWrite (led2Pin, LOW);
  digitalWrite (led3Pin, LOW);
  digitalWrite (led4Pin, LOW);
  pinMode(btn5, INPUT);
  pinMode(led5, OUTPUT);
  pinMode(btn6, INPUT);
  pinMode(led6, OUTPUT);


 // initialize OLED display with address 0x3C for 128x64
  if (!oled.begin(SSD1306_SWITCHCAPVCC, 0x3C)) {
    Serial.println(F("SSD1306 allocation failed"));
    while (true);
  }

  delay(2000);         // wait for initializing
  oled.clearDisplay(); // clear display

  oled.setTextSize(2);          // text size
  oled.setTextColor(WHITE);     // text color
  oled.setCursor(1, 15);        // position to display
  oled.println("Hi There!"); // text to display
  oled.display();               // show on OLED
  
}


void loop(){

  Serial.begin(9600);
  
 
   // Select LED if button debounced
  if (butndown(digitalRead(btn4), &bcount4, &bstate4, 2UL )) {
    digitalWrite (led1Pin, LOW);
    digitalWrite (led2Pin, LOW);
    digitalWrite (led3Pin, LOW);
    digitalWrite (led4Pin, HIGH);
  }
  // Select LED if button debounced
  if (butndown(digitalRead(btn3), &bcount3, &bstate3, 2UL )) {
    digitalWrite (led1Pin, LOW);
    digitalWrite (led2Pin, LOW);
    digitalWrite (led3Pin, HIGH);
    digitalWrite (led4Pin, LOW);
  }
 
  // Select LED if button debounced
  if (butndown(digitalRead(btn2), &bcount2, &bstate2, 2UL )) {
    digitalWrite (led1Pin, LOW);
    digitalWrite (led2Pin, HIGH);
    digitalWrite (led3Pin, LOW);
    digitalWrite (led4Pin, LOW);
  }
   // Select LED if button debounced
  if (butndown(digitalRead(btn1), &bcount1, &bstate1, 2UL )) {
    digitalWrite (led1Pin, HIGH);
    digitalWrite (led2Pin, LOW);
    digitalWrite (led3Pin, LOW);
    digitalWrite (led4Pin, LOW);
  }
  
 
  
  // Button 5 Toggle
   if(digitalRead(btn5)){//Cuando el boon se preciona
    if(toggle1)
      toggle1=false;//Si estaba encendido se apaga
    else
      toggle1=true;//Si estaba apagado se enciende
  }
    while(digitalRead(btn5)){}//Se espera hasta que el boton se deje de presionar
  
  //Se cambia el estado de los leds

    digitalWrite(led5,toggle1);
  
  // Button 6 Toggle
   if(digitalRead(btn6)){//Cuando el boon se preciona
    if(toggle2)
      toggle2=false;//Si estaba encendido se apaga
    else
      toggle2=true;//Si estaba apagado se enciende
      
  }
    while(digitalRead(btn6)){}//Se espera hasta que el boton se deje de presionar
  
  //Se cambia el estado de los leds

    digitalWrite(led6,toggle2);
    



}