#define LED4 23
#define LED5 22
#define entradaproducto 32
#define salidaproducto 33
int tiempoproducto[10000];
int productos=0;
int imprimir=0;
int tic=0;
int tac=0;
int n=0;
int j=0;
int parpadeo=1000;
int led4=0;
int led5=0;

hw_timer_t *timer = NULL; //Uso este TIMER para contar tiempo
hw_timer_t *timer3 = NULL;



void IRAM_ATTR produccion() 
  {
    //if(emergencia==1)
    //productos=0;
    //for(int x=0;x<productos;x++) 
    //tiempoproducto[x]=0;
    //else

    n++;
    tic = n; //Cuenta el tiempo que pasa (n=1 --> 1ms)
    if(tic>5000+tac)
      {
        tac=tic;
        imprimir=1;
      }

    for(int x=0;x<productos;x++) //indica en cada posición del producto el tiempo que lleva en la cinta
      tiempoproducto[x]++;

    for (int i=0; i<productos; i++) 
      if(tiempoproducto[i]>5000)
        j++;
    
     for (int i=0; i<productos; i++) 
      tiempoproducto[i]=tiempoproducto[i+j]; //Desplazo los productos "j" posiciones hacia la izquierda
                                              //Pierdo la información de las posiciones que sustituyo (no la quiero)
  }

void IRAM_ATTR LEDsproduccion() 
  {     
    //if(emergencia==1)
    //digitalWrite(LED4, LOW);
    //digitalWrite(LED5, LOW);
    //else
    led4=led5;
    led5=!led5;
    digitalWrite(LED4, led4);
    digitalWrite(LED5, led5);
   }

void IRAM_ATTR entrada() 
  {
    //if(emergencia==1)
    //;
    //else
    detachInterrupt(digitalPinToInterrupt(entradaproducto)); //Elimino rebotes al presionar
    productos++;

    parpadeo=10e5/productos;

    timerAlarm(timer3,parpadeo, true, 0);
  }


void IRAM_ATTR salida() 
  {
    //if(emergencia==1)
    //;
    //else
    detachInterrupt(digitalPinToInterrupt(salidaproducto)); //Elimino rebotes al presionar
    
      productos=productos-j;

      if(productos>0)
        parpadeo=10e5/productos;

      else
        parpadeo=1000;

      timerAlarm(timer3,parpadeo, true, 0);

      j=0;
  }


void setup() 
  {
    Serial.begin(115200);
    
    pinMode(LED4, OUTPUT);
    pinMode(LED5, OUTPUT);
    
    pinMode(entradaproducto, INPUT);
    pinMode(salidaproducto, INPUT);

    // Configuración del temporizador
    timer = timerBegin(10e5); 
    timerAttachInterrupt(timer, &produccion);
    timerAlarm(timer,1000, true, 0); //interrupción cada 1 ms

    timer3 = timerBegin(10e5); 
    timerAttachInterrupt(timer3, &LEDsproduccion);
    timerAlarm(timer3,parpadeo, true, 0); //Como está en setup, aunque cambie el valor de parpadeo, la alarma se va a quedar igual con el valor inicial
  }


void loop() 
  {
    if(digitalRead(entradaproducto)==0)
      attachInterrupt(digitalPinToInterrupt(entradaproducto),entrada,HIGH);

    if(digitalRead(salidaproducto)==0)
      attachInterrupt(digitalPinToInterrupt(salidaproducto),salida,HIGH);

    if(imprimir==1)
    {
       Serial.printf("Productos %d  \n", productos);
    }

    imprimir=0;

    delay(10); //Se pone este delay para hacer que el programa vaya mejor
  }