#include <multiprotocolShield.h>
#include <MCP23008.h>
#include <Wire.h>
# define INACTIVO 0
# define ACTIVO 1
# define RESET 2
# define BUFFER_SIZE 750
int index = 0;
char buffer[BUFFER_SIZE];
struct Sistema {
  byte estado;
  char operando;
  int primero;
  int segundo;
  int resultado;
  int contador;
  };
void operar(struct Sistema &sist){
  switch (sist.operando){
    case '*':
      sist.resultado = sist.primero * sist.segundo;
      break;
    case '/':
      sist.resultado = sist.primero / sist.segundo;
      break;
    case '+':
      sist.resultado = sist.primero + sist.segundo;
      break;
    case '-':
      sist.resultado = sist.primero - sist.segundo;
      break;
    }
   Serial.println(sist.resultado);
  }
void setup_sistema(struct Sistema &sist){
  sist.estado = INACTIVO;
  sist.contador = 0;
  }
void loop_sistema(struct Sistema &sist, char &c){
  switch(sist.estado){
    case INACTIVO:
        if(c == '#'){
          sist.estado = ACTIVO;
          Serial.println("Introduce la operacion");
          } else {
            Serial.println("INCORRECTO");
            }
          break;
    case ACTIVO:
        if(sist.contador == 0){
          if(c == '*' || c == '/' || c == '+' || c == '-'){
          sist.operando = c;
          sist.contador++;
          Serial.println("Introduce el primer numero");
          } else {
            Serial.println("INCORRECTO");
            }
          } else if (sist.contador == 1){
            sist.primero = c - '0';
            sist.contador++;
            Serial.println("Introduce el segundo numero");
            } else if(sist.contador == 2){
              sist.segundo = c - '0';
              sist.estado = RESET;
              operar(sist);
              sist.contador = 0;
              sist.estado = INACTIVO;
              }
        break;
    }
  }
 //---------------------------------------------
 Sistema sist;
void setup() {
  pinMode(13, OUTPUT);
  Serial.begin(115200);
  delay(1000);
  Serial.setTimeout(30);
  socket0.ON();
  delay(100);
  socket0.setMUX();
  delay(100);

  setup_sistema(sist);
  // ----------------------------------------------------------------

  Serial.println("SET BT PAGEMODE 4");

}

void loop() {
  char c;
  while(Serial.available()== 0){
    Serial.println("Esperando...");
    delay(5000);
    }
  c = Serial.read();
  loop_sistema(sist, c);
}



void printSerialInput(int seconds){
  int counter = seconds * 1000 / 10;
  while( counter > 0 ){
    if( Serial.available() ){
      while(Serial.available() > 0) {
        int incomingByte = Serial.read();
        buffer[index] = (char)incomingByte;
        index++;
      }
    }
    delay(10);
    counter--;
  }
  if( index != 0 ){
    flushToSerialDebug( buffer, index );
    index = 0;
  }
}

void flushToSerialDebug(char* buffer, int len){
  socket1.ON();
  delay(100);
  socket1.setMUX();

  Serial.write(buffer, len);
  delay(100);

  socket0.ON();
  delay(100);
  socket0.setMUX();
  delay(100);
}