se/SE/stuff/P5_Automation_can-dev/_Slave_Ports.h

#include "_Slave_Ports_ttl_decrement.h"

typedef struct  {
  const char * const _Protocol;
  int _Slave_ID;
  int PortTypes;  //0xFF  =  1111 1111 {  PWM,  .....} = 0x80
 // byte has_Address;
  int Address ;
 // byte has_Local_Port;
  int LocalPort;
  int Exp_state;                  /*0xFF  =  1111 1111
                                    0x00  =  0000 0000  = OFF = 0V
                                    0x01  =  0000 0001  = ON = PWM max
                                    {
                                      bit 1 - OFF = 0V
                                      bit 2 - ON = PWM max
                                      bit 3 - not allocated
                                      bit 4 - not allocated
                                      bit 2 - not allocated
                                      bit 5 - not allocated
                                      bit 6 - not allocated
                                      bit 7 - not allocated
                                      bit 8 - not allocated
                                    }*/
  int Exp_state_ttl;  // 0x00 = odswiezyc
} _Slave_Port;

_Slave_Port _Slave_Ports[] = {
  {"CAN", 0x102, 0x01, 0x00, 0x00, 0x00, 0x00 }
  //,
  //{"CAN", 0x102, 0x01, 0x00, 0x01, 0xFF, 0x6d } //testowy ttl
};








 struct _Slave_Ports_queue_tasksS {
  int queueID;
  int _Slave_Ports_queue_task_type ; /*
              { 0x01 _Slave_Ports_ttl_decrement, 
                 0x02  request_confirm_Exp_state ,
                 0x03  request_set__new_Exp_state,
                  }
  */
  int _Slave_Port_link; //todo link
 long time_seq_id;
 long time_min_run;
} ;

typedef struct _Slave_Ports_queue_tasksS _Slave_Ports_queue_tasksT;

_Slave_Ports_queue_tasksT _Slave_Ports_queue_tasks_LIST[11];



  


void _Slave_Ports_queue__INIT( _Slave_Ports_queue_tasksT* _Slave_Ports_queue_tasks_LIST) {
  Serial.println("_Slave_Ports_queue__INIT");
   int i;
  for(i=0;i<10;i++) {
   _Slave_Ports_queue_tasks_LIST[i].queueID = 0;
     _Slave_Ports_queue_tasks_LIST[i]._Slave_Ports_queue_task_type = 0x00;
      _Slave_Ports_queue_tasks_LIST[i]._Slave_Port_link = 0x00;
       _Slave_Ports_queue_tasks_LIST[i].time_seq_id = 0;
        _Slave_Ports_queue_tasks_LIST[i].time_min_run = 0;
        
      //  _Slave_Ports_queue_tasks_LIST[i]=_Slave_Ports_queue_tasks_LIST[i];
   }
   
}


char _Slave_Ports_queue_task_type_DESC( int _Slave_Ports_queue_task_type ) {//, int* res
 /* if(_Slave_Ports_queue_task_type == 0x01) res=0x99; //res="_Slave_Ports_ttl_decrement";
  else if(_Slave_Ports_queue_task_type == 0x02) res=0x99; //res="request_confirm_Exp_state";
  else if(_Slave_Ports_queue_task_type == 0x03) res=0x99; //res="request_set__new_Exp_state";
  else {
    res=0x99; // res="_UNKNOIWN";
    Serial.print("#82 Get [");  Serial.print(_Slave_Ports_queue_task_type); Serial.println("] #82 [U] ");
  }
  */
 // char return_i;
  Serial.print("=["); Serial.print(_Slave_Ports_queue_task_type); Serial.print("] ");
 if(_Slave_Ports_queue_task_type == 0x01)   Serial.print("_Slave_Ports_ttl_decrement"); // return "_Slave_Ports_ttl_decrement";
  else if(_Slave_Ports_queue_task_type == 0x02)  Serial.print("request_confirm_Exp_state"); //return "request_confirm_Exp_state";
  else if(_Slave_Ports_queue_task_type == 0x03)   Serial.print("request_set__new_Exp_state"); //return "request_set__new_Exp_state";
  else //return_i = "_UNKNOIWN"; //return "_UNKNOIWN";
   Serial.print("_UNKNOIWN");
// Serial.print((String)return_i);
//  return return_i ;
}


//Queue<_Slave_Ports_queueT> _Slave_Ports_queue = Queue<_Slave_Ports_queueT>(5);
void _Slave_Ports_queue__list( _Slave_Ports_queue_tasksT* _Slave_Ports_queue_tasks_LIST) {
  int i;
    Serial.println("#100 _Slave_Ports_queue_tasks_LIST): ");
    //Serial.println(sizeof(_Slave_Ports_queue_tasks_LIST));
        for(i=0;i<=10;i++) { //sizeof(_LCD_print_buffors)

          if(_Slave_Ports_queue_tasks_LIST[i].queueID == 0 and _Slave_Ports_queue_tasks_LIST[i].queueID == 0 and _Slave_Ports_queue_tasks_LIST[i]._Slave_Ports_queue_task_type == 0 and _Slave_Ports_queue_tasks_LIST[i]._Slave_Port_link == 0 and _Slave_Ports_queue_tasks_LIST[i].time_seq_id == 0 and _Slave_Ports_queue_tasks_LIST[i].time_min_run == 0 ) {
            
          } else {
                Serial.print(" $i[");
                Serial.print(i);

                 Serial.print("] queueID: ");
                Serial.print(_Slave_Ports_queue_tasks_LIST[i].queueID);

                
                 Serial.print("] _Slave_Ports_queue_task_type: ");
                 //Slave_Ports_queue_task_type_DESC(_Slave_Ports_queue_tasks_LIST[i]._Slave_Ports_queue_task_type);
                 int res = _Slave_Ports_queue_task_type_DESC(_Slave_Ports_queue_tasks_LIST[i]._Slave_Ports_queue_task_type);  Serial.print(res);
               // Serial.print(_Slave_Ports_queue_task_type_DESC(_Slave_Ports_queue_tasks_LIST[i]._Slave_Ports_queue_task_type)) ; //(res); //_Slave_Ports_queue_task_type_DESC(_Slave_Ports_queue_tasks_LIST[i]._Slave_Ports_queue_task_type

  
                 Serial.print("] _Slave_Port_link: ");
                Serial.print(_Slave_Ports_queue_tasks_LIST[i]._Slave_Port_link);
                     
                     
                    Serial.print("] time_seq_id: ");
                Serial.print(_Slave_Ports_queue_tasks_LIST[i].time_seq_id);

                     Serial.print("] time_min_run: ");
                Serial.println(_Slave_Ports_queue_tasks_LIST[i].time_min_run);
                }
  
        }
}

/*
 struct _Slave_Ports_queue_tasksS {
  int queueID;
  int _Slave_Ports_queue_task_type ; /*
              { 0x01 _Slave_Ports_ttl_decrement, 
                 0x02  request_confirm_Exp_state ,
                 0x03  request_set__new_Exp_state,
                 0x04   _Slave_Ports_ttl_decrement }
 
  int _Slave_Port_link; //todo link
 long time_seq_id;
 long time_min_run;
} ;

 */
void _Slave_Ports_queue__add( _Slave_Ports_queue_tasksT* _Slave_Ports_queue_tasks_LIST,int _Slave_Ports_queue_task_type,int _Slave_Port_link,long time_seq_id, long time_min_run //, 
//int _Slave_Ports_queue_peek , int _Slave_Ports_queue_push , int _Slave_Ports_queue_peek_new
) {
  Serial.println(".");
      Serial.print("#152 _Slave_Ports_queue__add  peek: ["); 
       int _Slave_Ports_queue_peek = _Slave_Ports_queue.peek() ;
       int _Slave_Ports_queue_back = _Slave_Ports_queue.back() ;
     //  int _Slave_Ports_queue_push_new_ref;
      // if(_Slave_Ports_queue_back > _Slave_Ports_queue_peek)
      Serial.print(_Slave_Ports_queue_peek);  Serial.print("] cur back[");  Serial.print(_Slave_Ports_queue_back); Serial.print("] ");
      
     
     _Slave_Ports_queue.push(_Slave_Ports_queue_back + 1);
      int _Slave_Ports_queue_peek_new = _Slave_Ports_queue.peek() ;
     // int _Slave_Ports_queue__push = _Slave_Ports_queue__peek + 1 ;
             Serial.print("] new peek[");
             Serial.print(_Slave_Ports_queue_peek_new );    Serial.print("]  planned["); Serial.print(_Slave_Ports_queue_back + 1 );  
             Serial.print("] front[");   Serial.print(_Slave_Ports_queue.front());   Serial.print("] back[");   Serial.print(_Slave_Ports_queue.back());  Serial.println("] ");

 
             
     _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_back + 1 ].queueID=_Slave_Ports_queue_back + 1 ;
     _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_back + 1 ]._Slave_Ports_queue_task_type=_Slave_Ports_queue_task_type ;
     _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_back + 1 ]._Slave_Port_link=_Slave_Port_link ;
     _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_back + 1 ].time_seq_id=time_seq_id ;
     _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_back + 1 ].time_min_run=time_min_run ;
    
}

/*
 void _Slave_Ports_queue__add(const _Slave_Ports_queue_tasksT*  &_Slave_Ports_queue_tasks_LIST  ,
int _Slave_Ports_queue_task_type, int _Slave_Port_link, long time_seq_id, long time_min_run //, 
//int _Slave_Ports_queue_peek , int _Slave_Ports_queue_push , int _Slave_Ports_queue_peek_new
) {
      Serial.print("#152 _Slave_Ports_queue__add  peek: ["); 
       int _Slave_Ports_queue_peek = _Slave_Ports_queue.peek() ;
      Serial.print(_Slave_Ports_queue_peek);
      
     
      int _Slave_Ports_queue_push = _Slave_Ports_queue_peek + 1;
      int _Slave_Ports_queue_peek_new = _Slave_Ports_queue_push ; //_Slave_Ports_queue.peek() ;
     // int _Slave_Ports_queue__push = _Slave_Ports_queue__peek + 1 ;
             Serial.print("] new peek[");
             Serial.print(_Slave_Ports_queue_peek_new );    Serial.print("]  planned["); Serial.print(_Slave_Ports_queue_peek + 1 );   Serial.println("]");
     _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_peek_new].queueID=_Slave_Ports_queue_peek_new;
     _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_peek_new]._Slave_Ports_queue_task_type=_Slave_Ports_queue_task_type ;
     _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_peek_new]._Slave_Port_link=_Slave_Port_link ;
     _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_peek_new].time_seq_id=time_seq_id ;
     _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_peek_new].time_min_run=time_min_run ;

    //return _Slave_Ports_queue_tasks_LIST;
}


*/





 void _Slave_Ports_ttl_decrement_POP(_Slave_Ports_queue_tasksT*  _Slave_Ports_queue_tasks_LIST,int _Slave_Ports_queue_pop ,  _Slave_Port* _Slave_Ports) {
     Serial.print("#213 _Slave_Ports_ttl_decrement_POP.   sizeof _Slave_Ports[");     Serial.print(sizeof(_Slave_Ports));
    int i;
    for(i=0;i<=100;i++) {
      if(_Slave_Ports[i]._Protocol == "CAN") {
            if(_Slave_Ports[i].Exp_state_ttl > 0x00 ) {
               Serial.print("#217 ttl min for: Prot[");  Serial.print(_Slave_Ports[i]._Protocol);   Serial.print("] ttl[");  Serial.print(_Slave_Ports[i].Exp_state_ttl);  Serial.print(" id[");  Serial.print(i);   Serial.println("]  "); 
            }

      }
    }
   
 /*
   const char * const _Protocol;
  int _Slave_ID;
  int PortTypes;  //0xFF  =  1111 1111 {  PWM,  .....} = 0x80
 // byte has_Address;
  int Address ;
 // byte has_Local_Port;
  int LocalPort;
  int Exp_state;                  /*0xFF  =  1111 1111
                                    0x00  =  0000 0000  = OFF = 0V
                                    0x01  =  0000 0001  = ON = PWM max
                                    {
                                      bit 1 - OFF = 0V
                                      bit 2 - ON = PWM max
                                      bit 3 - not allocated
                                      bit 4 - not allocated
                                      bit 2 - not allocated
                                      bit 5 - not allocated
                                      bit 6 - not allocated
                                      bit 7 - not allocated
                                      bit 8 - not allocated
                                   
  int Exp_state_ttl;  // 0x00 = odswiezyc

  */
 
 } 


 

 void _Slave_Ports_queue__POP( _Slave_Ports_queue_tasksT* _Slave_Ports_queue_tasks_LIST, 
 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_Port* _Slave_Ports) {
   //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_queue_tasks_LIST[_Slave_Ports_queue_pop].queueID == 0 and 
                _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_pop].queueID == 0 and 
                  _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_pop]._Slave_Ports_queue_task_type == 0 and 
                    _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_pop]._Slave_Port_link == 0 and 
                      _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_pop].time_seq_id == 0 and 
                        _Slave_Ports_queue_tasks_LIST[_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 = " Running task";
                   String LCDarray2 = "ID: ";
                    LCDarray2.concat( _Slave_Ports_queue_pop);  LCDarray2.concat("] ");
                   Serial.print(LCDarray1);
                   Serial.println(LCDarray2);
                    LCD_print(LCDarray1, LCDarray2, LCDtim / 3 ) ;

                        if( _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_pop]._Slave_Ports_queue_task_type = 0x01 ) {
                           Serial.print("#224 running _Slave_Ports_ttl_decrement = ");     Serial.println( _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_pop]._Slave_Ports_queue_task_type);
                            #include "_Slave_Ports_ttl_decrement.h"
                           _Slave_Ports_ttl_decrement_POP(_Slave_Ports_queue_tasks_LIST, _Slave_Ports_queue_pop ,  _Slave_Ports ) ; 

                           
                        } else {
                            Serial.print("Error unsupported type ");     Serial.println( _Slave_Ports_queue_tasks_LIST[_Slave_Ports_queue_pop]._Slave_Ports_queue_task_type);
                        }

                    
              }


   
  } else {
    String LCDarray1 = "Nothing to";
    String LCDarray2 = "process...";
    Serial.print(LCDarray1); 
    Serial.println(LCDarray2); 
    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 ) ;
  }
 }














/*
struct _Slave_Port
{ 
  char _Protocol ;
  int _Slave_ID;
  char Port_Type;
  int Address;
  int LocalPort ;
  void (*fn)();
};


struct _Slave_Port {
   
}

#define _Slave_Port =   { "CAN" , 0x102 , "PWM", 0x00, 0  } 

*/

  /* #define __CAN_Ports { _Slave1_ID } ;


   #define __CAN_Ports_PWM { _Slave1_ID 
    {0x00 , 0 } ,
    {0x00 , 1 }
   } ;

   */
/*
   typedef struct
 {
     int Slave1_ID;
     String PortType;
     int Address;
     int LocalPort ;
 } 

*/
/*

struct buttons
{ 
  int color[3];
  int positions[4];
  char init[20];
  void (*fn)();
};

//void func1();
//void func2();

  
buttons test[] = 
{
  { {0,0,0},    {0,0,100,100}, "getSomething",  func1 },
  { {40,40,40}, {50,50,10,10}, "somethingElse", func2 },
};
*/

/*
typedef struct  {
  const char * const l_name;
  byte x_m;
  byte y_m;
  boolean period[4];
} myStruct;

myStruct structs[] = {
  {"My Name", 0, 0, {true, true, false, false}},
  {"My Second Name", 0, 0, {true, false, true, false}}
};
*/



 //#define _CAN_P_0x102_PWM0x00_0 { _Slave1_ID , "PWM", 0x00, 0 } 
 //#define _CAN_P_0x102_PWM0x00_1 { _Slave1_ID , "PWM", 0x00, 1 } 
 // char _Slave_Ports ;
 // _Slave_Ports[0] = "_CAN_P_0x102_PWM0x00_0"  ;
 // _Slave_Ports[1] = "_CAN_P_0x102_PWM0x00_1"  ;

 // char *_Slave_Ports[] = { "_CAN_P_0x102_PWM0x00_0", "_CAN_P_0x102_PWM0x00_1" } ;