//_Slave_Ports.h

#include "_Slave_Ports_ttl_decrement.h"
//#include "_Slave_Ports_Protocol.h"

//#include "Slave_Ports_Status_S.h"


Slave_Ports_Status_QUEUE_T Slave_Ports_Status_QUEUE_A[11];




 void _Slave_Ports_queue__POP( Slave_Ports_Status_QUEUE_T* Slave_Ports_Status_QUEUE_A, 
 int _Slave_Ports_queue_count, 
 int _Slave_Ports_queue_pop, 
 int _Slave_Ports_queue_front, 
 int _Slave_Ports_queue_back,
 int _Slave_Ports_queue_peek,
 int LCDtim,   Slave_Ports_Status_T*  Slave_Ports_Status_A) {
   //int count = _Slave_Ports_queuev.count();
   //int _Slave_Ports_queue_pop _Slave_Ports_queuev.pop();
  Serial.print("#180 run _Slave_Ports_queue__POP cnt "); Serial.print(_Slave_Ports_queue_count); Serial.print(" , pop: "); Serial.println(_Slave_Ports_queue_pop);

   
    if (_Slave_Ports_queue_count > 0) {

                             String LCDarray1 = "`Slave_Ports_queue size [";
                             LCDarray1.concat(_Slave_Ports_queue_count);
                             LCDarray1.concat("] Oldest["); 
                             LCDarray1.concat(_Slave_Ports_queue_pop);
                             
                             LCDarray1.concat("] Curr[");
                             LCDarray1.concat(_Slave_Ports_queue_front);

                             String LCDarray2 = "]  last[";
                             LCDarray2.concat(_Slave_Ports_queue_back);
                             LCDarray2.concat("] Next[");
                             LCDarray2.concat(_Slave_Ports_queue_peek);
                             
  
    Serial.print(LCDarray1);
    Serial.println(LCDarray2);
//    LCD_print(LCDarray1, LCDarray2, LCDtim / 3 ) ;

              if(Slave_Ports_Status_QUEUE_A[_Slave_Ports_queue_pop].QUEUE_ID_A == 0 and 
                Slave_Ports_Status_QUEUE_A[_Slave_Ports_queue_pop].QUEUE_ID_A == 0 and 
                  Slave_Ports_Status_QUEUE_A[_Slave_Ports_queue_pop].TASK_TYPE_A == 0 and 
                    //Slave_Ports_Status_QUEUE_A[_Slave_Ports_queue_pop].TASK_PORT_ASSOC_A == 0 and 
                      Slave_Ports_Status_QUEUE_A[_Slave_Ports_queue_pop].time_seq_id == 0 and 
                        Slave_Ports_Status_QUEUE_A[_Slave_Ports_queue_pop].time_min_run == 0 ) {
                   String LCDarray1 = "#206 Error with queue";
                   String LCDarray2 = "ID: ";
                    LCDarray2.concat( _Slave_Ports_queue_pop);  LCDarray2.concat("] ");
                   Serial.print(LCDarray1);
                   Serial.println(LCDarray2);
          //          LCD_print(LCDarray1, LCDarray2, LCDtim / 3 ) ;
              } else {
                   String LCDarray1 = "#407 Running task";
                   String LCDarray2 = "ID: ";
                    LCDarray2.concat( _Slave_Ports_queue_pop);  LCDarray2.concat("] task_type[");
                      
                        LCDarray2.concat( Slave_Ports_Status_QUEUE_A[_Slave_Ports_queue_pop].TASK_TYPE_A);  LCDarray2.concat("] ");
                   
                   Serial.print(LCDarray1);
                   Serial.println(LCDarray2);
            //        LCD_print(LCDarray1, LCDarray2, LCDtim / 3 ) ;


                     switch (Slave_Ports_Status_QUEUE_A[_Slave_Ports_queue_pop].TASK_TYPE_A) {
                            case TASK_TYPE_T_Slave_Ports_ttl_decrement:    // your hand is on the sensor
                                      Serial.print("#224 running _Slave_Ports_ttl_decrement = ");     Serial.println( Slave_Ports_Status_QUEUE_A[_Slave_Ports_queue_pop].TASK_TYPE_A);
                                      //#include "_Slave_Ports_ttl_decrement.h"
                                      _Slave_Ports_ttl_decrement_POP(Slave_Ports_Status_QUEUE_A, _Slave_Ports_queue_pop ,  Slave_Ports_Status_A ) ;  
                                      break;
                                      
                            case TASK_TYPE_T_Slave_Ports_broadcast____:
                                      Serial.print("#337 running _Slave_Ports_broadcast = ");     Serial.println( Slave_Ports_Status_QUEUE_A[_Slave_Ports_queue_pop].TASK_TYPE_A);
                                     // #include "_Slave_Ports_ttl_decrement.h"
                                     _Slave_Ports_broadcast_POP(Slave_Ports_Status_QUEUE_A, _Slave_Ports_queue_pop ,  Slave_Ports_Status_A, LCDtim ) ; 
                                     break;

                             Serial.print("Error unsupported type ");     Serial.println( Slave_Ports_Status_QUEUE_A[_Slave_Ports_queue_pop].TASK_TYPE_A);     
                     }

                    
              }


   
  } else {
    String LCDarray1 = "Nothing to";
    String LCDarray2 = "process...";
    //LCDarray2.reserve(16);
    Serial.print(LCDarray1); 
    Serial.println(LCDarray2); 

   //  Serial.print("#32 String LCDarray2 len"); 
    // int LCDarray2_length = LCDarray2.length;
   /*  Serial.print(LCDarray2.length()); 
     Serial.println("] now "); 
     LCDarray2 = make_str16(LCDarray2);
    Serial.print(LCDarray2.length()); 
     Serial.println("]  next #338"); 

      for(int i = 0; i < (17 - LCDarray2.length()); i++)
        LCDarray2 += 'x';  
       
      Serial.print(LCDarray2.length()); 
     Serial.println("]  "); 
 */
    
    Serial.print(" #364 scount "); 
     Serial.print(_Slave_Ports_queue_count); 
     Serial.print(" _Slave_Ports_queue.front(): "); 
     Serial.print(_Slave_Ports_queue_front); 
     Serial.print(" _Slave_Ports_queue.back(): "); 
     Serial.print(_Slave_Ports_queue_back); 
     Serial.print(" _Slave_Ports_queue.peek(): "); 
     Serial.println(_Slave_Ports_queue_peek); 
//     LCD_print(LCDarray1, LCDarray2, LCDtim / 3 ) ;
  }
 }