a

SE/stuff/P5_Automation_can-dev-res-working-1930/TASK_TYPE_T_Set_Port_Smooth_forward__.h

@@ -20,6 +20,11 @@ void TASK_TYPE_T_Set_Port_Smooth_forward__POP(
         
         if(TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX) {
                 SPFTFTFT2(task,smooth,delta,TASK_PORT_ASSOC_A.Exp_state_level_NEW_DELTA_A );
+                SPFT2(old,Slave_Ports_Status_A[TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX].Exp_state_level_A);
+                SPFT2(new, Slave_Ports_Status_A[TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX].Exp_state_level_A
+                                                                + TASK_PORT_ASSOC_A.Exp_state_level_NEW_DELTA_A );
+
+                //callback
                 
                  Slave_Ports_action_func(Slave_Ports_Status_QUEUE_A,  Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A, Slave_Ports_Status_A ,
                                                             Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A , TASK_TYPE_T_request_set_new_Exp_state ,

SE/stuff/P5_Automation_can-dev-res-working-1930/_DISPLAY_func.h

@@ -745,11 +745,64 @@ void DISPLAY_MENU_SELECTOR(DISPLAY_T* DISPLAY_A ,
             
             
             } else if(DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_SELECTOR_STATUS_A == DISPLAY_MENU_SELECTOR_ITEM_OPTIONS_USE_LEVEL_FLAG) { //else if(DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_SELECTOR_STATUS_A == DISPLAY_MENU_SELECTOR_ITEM_FLAG)
+             
+
+                TASK_PORT_ASSOC_T TASK_PORT_ASSOC_SMOOTH_A ;
+                    TASK_PORT_ASSOC_SMOOTH_A.Slave_Ports_Status_T_INDEX = DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].ARDUINO_ARRAY_INDEX_A ;
+                    TASK_PORT_ASSOC_SMOOTH_A.DISPLAY_MENU_INDEX_A      = DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A;         
+                    TASK_PORT_ASSOC_SMOOTH_A.DISPLAY_MENU_ITEM_INDEX_A = DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A;   
+                    //TASK_PORT_ASSOC_SMOOTH_A.Exp_state_level_NEW_DELTA_A = 15;         
+
+             
+             
+             
                 if(DISPLAY_MENU_SELECTOR_oldEncPos_A > DISPLAY_MENU_SELECTOR_encoderPos_A) {
+                TASK_PORT_ASSOC_SMOOTH_A.Exp_state_level_NEW_DELTA_A = -2;
                  SPFT(level);SPFT(minus);SPFT2(encoder,DISPLAY_MENU_SELECTOR_encoderPos_A);SPFT2(old,DISPLAY_MENU_SELECTOR_oldEncPos_A);
                  Serial.print(DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A);
                              if(DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A > 0) {
-                             DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A -=5 * abs(DISPLAY_MENU_SELECTOR_oldEncPos_A - DISPLAY_MENU_SELECTOR_encoderPos_A)  ; //--;
+                            
+                            
+                             SPL();SPFTFT2(millis,debug,748); PROGMEM_CONSOLE_WRITE_CHAR("#748",TASK_TYPE_T_Set_Port_Smooth_forward__);
+                                        if(encoderPos_t < millis() ) {
+                                             SPFT2(overload,1000);SP(encoderPos_t - millis()) ; PROGMEM_CONSOLE_WRITE_CHAR(">1000",TASK_TYPE_T_Set_Port_Smooth_forward__);
+                                             encoderPos_t = millis() + 1000 ;
+                                             encoderPos_t1 = millis() + 500 ;
+                                             encoderPos_t2 = millis() + 250 ;
+                                            _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,  TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 100, ARDUINO_ARRAY_INDEX_NOT_SET) ;
+
+                                        } else if(encoderPos_t1 < millis()   ) {
+                                         SPL();
+                                         SPFT2(overload,500);SP(encoderPos_t - millis()); PROGMEM_CONSOLE_WRITE_CHAR(">500",TASK_TYPE_T_Set_Port_Smooth_forward__);
+                                             encoderPos_t = millis() + 1000 ;
+                                             encoderPos_t1 = millis() + 500 ;
+                                             encoderPos_t2 = millis() + 250 ;
+                                                                              
+                                             _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,  TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 50, ARDUINO_ARRAY_INDEX_NOT_SET) ;
+                                             _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,  TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 100, ARDUINO_ARRAY_INDEX_NOT_SET) ;
+                                        } else if(encoderPos_t2 < millis()  ) {
+                                         SPL();
+                                         SPFT2(overload,250);SP(encoderPos_t - millis()); PROGMEM_CONSOLE_WRITE_CHAR(">250",TASK_TYPE_T_Set_Port_Smooth_forward__);
+                                             encoderPos_t = millis() + 1000 ;
+                                             encoderPos_t1 = millis() + 500 ;
+                                             encoderPos_t2 = millis() + 250 ;
+                                                                                    
+                                            _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A , TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 25, ARDUINO_ARRAY_INDEX_NOT_SET) ;
+                                             _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A , TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 50, ARDUINO_ARRAY_INDEX_NOT_SET) ;
+                                             _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A , TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 75, ARDUINO_ARRAY_INDEX_NOT_SET) ;
+                                             _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A , TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 100, ARDUINO_ARRAY_INDEX_NOT_SET) ;
+                                             _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A , TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 125, ARDUINO_ARRAY_INDEX_NOT_SET) ;
+                                        } else  { 
+                                          SPFT2(overload,0); SP(encoderPos_t - millis());
+                                        }
+                                  
+                            
+                            
+                            
+                            
+                            
+                              DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A = Slave_Ports_Status_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].ARDUINO_ARRAY_INDEX_A].Exp_state_level_A ;
+                            /* DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A -=5 * abs(DISPLAY_MENU_SELECTOR_oldEncPos_A - DISPLAY_MENU_SELECTOR_encoderPos_A)  ; //--;
                              if(DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A < 0 ) DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A = 0 ;
                                     TASK_PORT_ASSOC_T TASK_PORT_ASSOC_A={0,0,DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].ARDUINO_ARRAY_INDEX_A};
                                     
@@ -761,18 +814,15 @@ void DISPLAY_MENU_SELECTOR(DISPLAY_T* DISPLAY_A ,
                                                     DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A   
                                                    );
                                     
-                                    
+                             */       
                              } //if(DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A > 0) {
                 } else if(DISPLAY_MENU_SELECTOR_oldEncPos_A < DISPLAY_MENU_SELECTOR_encoderPos_A) {
+                            TASK_PORT_ASSOC_SMOOTH_A.Exp_state_level_NEW_DELTA_A = 2;
                              if(DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A < 254) {
-                                   int overload;
-                                   overload = 1 ;
-                                    TASK_PORT_ASSOC_T TASK_PORT_ASSOC_SMOOTH_A ;
-                                        TASK_PORT_ASSOC_SMOOTH_A.Slave_Ports_Status_T_INDEX = DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].ARDUINO_ARRAY_INDEX_A ;
-                                        TASK_PORT_ASSOC_SMOOTH_A.Exp_state_level_NEW_DELTA_A = 5;         
-                                    SPL();SPFTFT2(millis,debug,748);
+                                        
+                                    SPL();SPFTFT2(millis,debug,748); PROGMEM_CONSOLE_WRITE_CHAR("#748",TASK_TYPE_T_Set_Port_Smooth_forward__);
                                         if(encoderPos_t < millis() ) {
-                                             SPFT2(overload,1000);SP(encoderPos_t - millis());
+                                             SPFT2(overload,1000);SP(encoderPos_t - millis()) ; PROGMEM_CONSOLE_WRITE_CHAR(">1000",TASK_TYPE_T_Set_Port_Smooth_forward__);
                                              encoderPos_t = millis() + 1000 ;
                                              encoderPos_t1 = millis() + 500 ;
                                              encoderPos_t2 = millis() + 250 ;
@@ -780,30 +830,32 @@ void DISPLAY_MENU_SELECTOR(DISPLAY_T* DISPLAY_A ,
 
                                         } else if(encoderPos_t1 < millis()   ) {
                                          SPL();
-                                         SPFT2(overload,500);SP(encoderPos_t - millis());
+                                         SPFT2(overload,500);SP(encoderPos_t - millis()); PROGMEM_CONSOLE_WRITE_CHAR(">500",TASK_TYPE_T_Set_Port_Smooth_forward__);
                                              encoderPos_t = millis() + 1000 ;
                                              encoderPos_t1 = millis() + 500 ;
                                              encoderPos_t2 = millis() + 250 ;
                                                                               
+                                             _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,  TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 50, ARDUINO_ARRAY_INDEX_NOT_SET) ;
                                              _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,  TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 100, ARDUINO_ARRAY_INDEX_NOT_SET) ;
-                                             _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,  TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 200, ARDUINO_ARRAY_INDEX_NOT_SET) ;
                                         } else if(encoderPos_t2 < millis()  ) {
                                          SPL();
-                                         SPFT2(overload,250);SP(encoderPos_t - millis());
+                                         SPFT2(overload,250);SP(encoderPos_t - millis()); PROGMEM_CONSOLE_WRITE_CHAR(">250",TASK_TYPE_T_Set_Port_Smooth_forward__);
                                              encoderPos_t = millis() + 1000 ;
                                              encoderPos_t1 = millis() + 500 ;
                                              encoderPos_t2 = millis() + 250 ;
                                                                                     
+                                             _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A , TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 25, ARDUINO_ARRAY_INDEX_NOT_SET) ;
                                              _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A , TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 50, ARDUINO_ARRAY_INDEX_NOT_SET) ;
                                              _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A , TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 75, ARDUINO_ARRAY_INDEX_NOT_SET) ;
                                              _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A , TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 100, ARDUINO_ARRAY_INDEX_NOT_SET) ;
                                              _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A , TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 125, ARDUINO_ARRAY_INDEX_NOT_SET) ;
-                                             _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A , TASK_TYPE_T_Set_Port_Smooth_forward__ ,TASK_PORT_ASSOC_SMOOTH_A ,millis(), millis() + 150, ARDUINO_ARRAY_INDEX_NOT_SET) ;
                                         } else  { 
                                           SPFT2(overload,0); SP(encoderPos_t - millis());
                                         }
+                                  
+                                  
                                     DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A = Slave_Ports_Status_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].ARDUINO_ARRAY_INDEX_A].Exp_state_level_A ;
-                                    DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A += 2  ; //+;
+                                 /*   DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A += 2  ; //+;
                                     if(DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A >254) DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A = 254;
                                     TASK_PORT_ASSOC_T TASK_PORT_ASSOC_A={0,0,DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].ARDUINO_ARRAY_INDEX_A};
                                     Slave_Ports_Status_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].ARDUINO_ARRAY_INDEX_A].Exp_state_level_A = DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A ;
@@ -815,7 +867,7 @@ void DISPLAY_MENU_SELECTOR(DISPLAY_T* DISPLAY_A ,
                                                     DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A   
                                                    );
                                     
-                                    
+                                    */
                              } //if(DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_INDEX_A].DISPLAY_MENU_ITEM_A[DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_SELECTOR_A[1].DISPLAY_MENU_ITEM_INDEX_A].Exp_state_level_A < 254) {
                 } else { //  if(DISPLAY_MENU_SELECTOR_oldEncPos_A < DISPLAY_MENU_SELECTOR_encoderPos_A) {
                     SPFT2(error,750); //Serial.print("[ERR}750E");

SE/stuff/P5_Automation_can-dev-res-working-1930/_DISPLAY_struct.h

@@ -193,6 +193,25 @@ typedef struct DISPLAY_MENU_ITEM_S DISPLAY_MENU_ITEM_T ;
  typedef struct DISPLAY_MENU_S DISPLAY_MENU_T ;
  
  
+ 
+ struct DISPLAY_PHYSICAL_CHAR_NOMENU_S { 
+           DISPLAY_PHYSICAL_X_PX_T DISPLAY_PHYSICAL_X_PX_A ;
+           DISPLAY_PHYSICAL_Y_PX_T DISPLAY_PHYSICAL_Y_PX_A ;
+           DISPLAY_PHYSICAL_X_CHARS_T DISPLAY_PHYSICAL_X_CHARS_A;
+           DISPLAY_PHYSICAL_Y_CHARS_T DISPLAY_PHYSICAL_Y_CHARS_A;
+           DISPLAY_CURSOR_X_CHARS_T DISPLAY_CURSOR_X_CHARS_A;
+           DISPLAY_CURSOR_Y_CHARS_T DISPLAY_CURSOR_Y_CHARS_A ;
+           DISPLAY_textsize_x_T DISPLAY_textsize_x_A;
+           DISPLAY_textsize_y_T DISPLAY_textsize_y_A;
+           DISPLAY_ELEMENT_TO_REFRESH_T DISPLAY_ELEMENT_TO_REFRESH_A ;//= true;
+          // DISPLAY_MENU_T DISPLAY_MENU_A[ARDUINO_ARRAY_INDEX_LIMIT_DISPLAY_MENU] ;
+           //DISPLAY_MENU_SELECTOR_T DISPLAY_MENU_SELECTOR_A[1] ;
+
+ } ;
+ 
+   typedef  struct DISPLAY_PHYSICAL_CHAR_NOMENU_S DISPLAY_PHYSICAL_CHAR_NOMENU_T  ;
+
+ 
  struct DISPLAY_PHYSICAL_CHAR_S { 
            DISPLAY_PHYSICAL_X_PX_T DISPLAY_PHYSICAL_X_PX_A ;
            DISPLAY_PHYSICAL_Y_PX_T DISPLAY_PHYSICAL_Y_PX_A ;

SE/stuff/P5_Automation_can-dev-res-working-1930/_LCD1602_func.h

@@ -7,14 +7,26 @@ void LCD_print_DISPLAY_MENU_A(  //DISPLAY_PHYSICAL_CHAR_T &DISPLAY_PHYSICAL_CHAR
   #if defined(DISABLE_PROGMEM_CONSOLE_PRINT)
      #else
     //todo menu
-     for(int i=0 ; i< PROGMEM_CONSOLE_PRINT_LIMIT_A; i++ ) {
-        if(PROGMEM_CONSOLE_PRINT_A[i].DISPLAY_ELEMENT_TO_REFRESH_A == true) {
-          // lcd.print(PROGMEM_CONSOLE_PRINT_A[i].input_F_A);
-          // lcd.print(PROGMEM_CONSOLE_PRINT_A[i].input_C_A);
-          // lcd.print(i); 
-          // PROGMEM_CONSOLE_PRINT_A[i].DISPLAY_ELEMENT_TO_REFRESH_A = false;
-          // PROGMEM_CONSOLE_PRINT_A[i].input_F_A = NULL;
-          // PROGMEM_CONSOLE_PRINT_A[i].input_C_A = {};
+     for(int ii=0 ; ii< PROGMEM_CONSOLE_PRINT_LIMIT_A; ii++ ) {
+        if(PROGMEM_CONSOLE_PRINT_A[ii].DISPLAY_ELEMENT_TO_REFRESH_A == true) {
+           
+                    lcd.print(" ");
+                   // lcd.print(PROGMEM_CONSOLE_PRINT_A[i].input_C_A);
+                   // lcd.print(PROGMEM_CONSOLE_PRINT_A[i].input_C_A[1]);
+                   // lcd.print(String(PROGMEM_CONSOLE_PRINT_A[i].input_C_A));
+                    for(int ic = 0; ic <= String(PROGMEM_CONSOLE_PRINT_A[ii].input_C_A).length() ; ic ++) {
+                       // lcd.print(ic);
+                       if(PROGMEM_CONSOLE_PRINT_A[ii].input_C_A[ic] ==  "\0" ) break;
+                        lcd.print(PROGMEM_CONSOLE_PRINT_A[ii].input_C_A[ic]);
+                     }
+                   // lcd.print(F("test"));
+                 //   memset(0, PROGMEM_CONSOLE_PRINT_A[ii].input_C_A, 8);
+                    //PROGMEM_CONSOLE_PRINT_A[i].input_C_A[0] = 0 ;
+          
+            
+           PROGMEM_CONSOLE_PRINT_A[ii].DISPLAY_ELEMENT_TO_REFRESH_A = false;
+           
+           
         }
         
     }

SE/stuff/P5_Automation_can-dev-res-working-1930/_LCD1602_struct.h

@@ -1,6 +1,6 @@
      
                                  
- static      DISPLAY_PHYSICAL_CHAR_T   LCD_DISPLAY_PHYSICAL_CHAR_A =   { 
+ static      DISPLAY_PHYSICAL_CHAR_NOMENU_T   LCD_DISPLAY_PHYSICAL_CHAR_A =   { 
                  20*5,//LCD_DISPLAY_PHYSICAL_X_PX_A ,
                  4*8,////LCD_DISPLAY_PHYSICAL_Y_PX_A ,
                  20,//LCD_DISPLAY_PHYSICAL_X_CHARS_A,
@@ -8,10 +8,10 @@
                  0,//LCD_DISPLAY_CURSOR_X_CHARS_A,
                  0,//LCD_DISPLAY_CURSOR_Y_CHARS_A,
                  5,//LCD_DISPLAY_textsize_x_A,
-                 8//LCD_DISPLAY_textsize_y_A//, true
-                 //,
-                 //  {} ,
+                 8 //LCD_DISPLAY_textsize_y_A//, true
+                 //false,//,
                  //  {} ,
+                 //  {} 
                  //   DISPLAY_ELEMENT_TO_REFRESH_A_temp
                   }
           ;

SE/stuff/P5_Automation_can-dev-res-working-1930/_Slave_Ports_I2C_func.h

@@ -1,5 +1,11 @@
 //_Slave_Ports_I2C_func.h
 
+#if defined(_Slave_Ports_I2C_func_h)
+
+#else 
+
+#define _Slave_Ports_I2C_func_h
+
 
 void TASK_TYPE_T_Set_Port_Smooth_forward() {
 }
@@ -339,3 +345,5 @@ void TASK_TYPE_T_Set_Port_Smooth_forward() {
 
  } //func 1
 //#endif
+
+#endif

SE/stuff/P5_Automation_can-dev-res-working-1930/_Slave_Ports_I2C_func_PHYSICAL_PORT_SERVO.h

@@ -37,6 +37,7 @@
                             Slave_Ports_Status_A[i].Exp_state_level_A = 180;
                             SPFTFT2(error,level,">180");
                         } 
+                        SPL();
                        SPFTFT2(physical,index,drvindex);
                        SPFT2(port,Slave_Ports_Status_A[i].LocalPort)  ;
                        SPFT2(level, Slave_Ports_Status_A[i].Exp_state_level_A)  ;  

SE/stuff/P5_Automation_can-dev-res-working-1930/_Slave_Ports_Status_QUEUE_func.h

@@ -387,7 +387,7 @@ QUEUE_LATENCY_PASS__POP( time_seq_id_T time_seq_id_A,
                                     );
                                 } else {
                                     SPFTFTFT(smooth,run,testing);SPFTFT2(physical,port,Slave_Ports_Status_QUEUE_A[ARDUINO_ARRAY_INDEX_POP_LOCK_A].TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX);
-                                    
+                                    PROGMEM_CONSOLE_WRITE_CHAR("Q[SM>]",TASK_TYPE_T_Set_Port_Smooth_forward__);
                                     TASK_TYPE_T_Set_Port_Smooth_forward__POP(
                                         //Slave_Ports_Status_QUEUE_A, _Slave_Ports_queue_pop ,  Slave_Ports_Status_A 
                                          Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,

SE/stuff/P5_Automation_can-dev-res-working-1930/_Slave_Ports_Status_struct.h

@@ -34,7 +34,7 @@ struct Slave_Ports_Status_DESCR_S {
 } ;
 
 typedef Slave_Ports_Status_DESCR_S Slave_Ports_Status_DESCR_T ;
-//Slave_Ports_Status_DESCR_T Slave_Ports_Status_DESCR_A[ARDUINO_ARRAY_INDEX_LIMIT_PORTS];
+Slave_Ports_Status_DESCR_T Slave_Ports_Status_DESCR_A[ARDUINO_ARRAY_INDEX_LIMIT_PORTS];
 
  struct Slave_Ports_Status_S {
   Port_ID_T  Port_ID ; //global id for device //const char * const _Protocol;

SE/stuff/P5_Automation_can-dev-res-working-1930/_Slave_Ports_action_func.h

@@ -5,6 +5,9 @@
 
 #define Slave_Ports_action_func_h
 
+#include "_Slave_Ports_I2C_func.h"
+
+
 void Slave_Ports_action_func(
 Slave_Ports_Status_QUEUE_T* Slave_Ports_Status_QUEUE_A, 
      Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_T &Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A,
@@ -31,6 +34,7 @@ Slave_Ports_Status_QUEUE_T* Slave_Ports_Status_QUEUE_A,
                 Slave_Ports_Status_A[TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX].Exp_state_ttl = Exp_state_ttl_TO_REFRESH ;
                 Slave_Ports_Status_A[TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX].Exp_state_level_A = Exp_state_level_A ;
                 Slave_Ports_Status_A[TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX].DISPLAY_ELEMENT_TO_REFRESH_A = true ;
+                DISPLAY_PHYSICAL_CHAR_A.DISPLAY_ELEMENT_TO_REFRESH_A = true ;
                 if(Slave_Ports_Status_A[TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX].IS_Local_A == IS_Local_TRUE) flag_set_LOCAL ++ ;
                 if(Slave_Ports_Status_A[TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX].IS_Local_A == IS_Local_FALSE) flag_sent_CAN ++ ;
                 //_Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,
@@ -47,6 +51,7 @@ Slave_Ports_Status_QUEUE_T* Slave_Ports_Status_QUEUE_A,
                      if(Slave_Ports_Status_A[i].IS_Local_A == IS_Local_TRUE) flag_set_LOCAL ++ ;
                       if(Slave_Ports_Status_A[i].IS_Local_A == IS_Local_FALSE) flag_sent_CAN ++ ;
                       Slave_Ports_Status_A[i].DISPLAY_ELEMENT_TO_REFRESH_A = true;
+                      DISPLAY_PHYSICAL_CHAR_A.DISPLAY_ELEMENT_TO_REFRESH_A = true ;
                    // _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,
                    //  TASK_TYPE_T_request_set_new_Exp_state  ,TASK_PORT_ASSOC_A ,time_seq_id, time_min_run  , ARDUINO_ARRAY_INDEX_NOT_SET ) ; 
                 }
@@ -89,7 +94,7 @@ Slave_Ports_Status_QUEUE_T* Slave_Ports_Status_QUEUE_A,
                     String message ; 
                     byte sndStat = CAN0.sendMsgBuf(Active_ControllerID_HEX, //Active_ControllerID_HEX,
                          0, 8, CAN_MSG8_A_Slave_Ports_Protocol_CAN_request_set_new_Exp_state_A); 
-                    delay(200);
+                    delay(20);
                      if(sndStat == CAN_OK){
                      
                       Slave_Ports_Status_A[TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX].Exp_state = Slave_Ports_Status_A[TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX].Exp_state |  Exp_state_SET_REQ_SEND ;
@@ -108,12 +113,46 @@ Slave_Ports_Status_QUEUE_T* Slave_Ports_Status_QUEUE_A,
     
     
     } else if(flag_set_LOCAL > 0 ) {
-        Serial.println("51[ACTION][LOCAL][ADD][TASK_TYPE_T_Slave_Ports_set_I2C______]");
-         _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,
-                     TASK_TYPE_T_Slave_Ports_set_I2C______  ,TASK_PORT_ASSOC_A ,time_seq_id, time_min_run  , ARDUINO_ARRAY_INDEX_NOT_SET ) ;
+        
+        SPFTFTFT2(action,local,add,51);SPFTFTFTFT(task,type,set,i2c);
+        // _Slave_Ports_queue__add(  Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,
+        //             TASK_TYPE_T_Slave_Ports_set_I2C______  ,TASK_PORT_ASSOC_A ,0, 0  , ARDUINO_ARRAY_INDEX_NOT_SET ) ;
+                     
+                     
+                     //#####
+                 
+                     _Slave_Ports_I2C_POP(
+                                        //Slave_Ports_Status_QUEUE_A, _Slave_Ports_queue_pop ,  Slave_Ports_Status_A 
+                                         Slave_Ports_Status_QUEUE_A, Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,
+                                         0, //ARDUINO_ARRAY_INDEX_POP_LOCK_A ,  
+                                         Slave_Ports_Status_A,
+                                          Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A ,
+                                           //display
+                                             DISPLAY_A ,
+                                             DISPLAY_T_ARDUINO_ATTR_ARRAY_A , 
+                                             DISPLAY_PHYSICAL_CHAR_A, 
+                                                 DISPLAY_pos_seq_A_NEXT | DISPLAY_pos_seq_A_IMMEDIATE, //initial set
+                                                 "#233 Setting I2C" , //DISPLAY_array16_A,
+                                                  DISPLAY_TARGET_ANY , //DISPLAY_TARGET_A, - setting
+                                                  0,//Slave_Ports_Status_QUEUE_A[ARDUINO_ARRAY_INDEX_POP_LOCK_A].time_seq_id, 
+                                                  0,// Slave_Ports_Status_QUEUE_A[ARDUINO_ARRAY_INDEX_POP_LOCK_A].time_min_run,
+                                             //tasks
+                                             TASK_TYPE_T_Slave_Ports_set_I2C______ ,//  Slave_Ports_Status_QUEUE_A[ARDUINO_ARRAY_INDEX_POP_LOCK_A].TASK_TYPE_A,
+                                              TASK_PORT_ASSOC_A , // Slave_Ports_Status_QUEUE_A[ARDUINO_ARRAY_INDEX_POP_LOCK_A].TASK_PORT_ASSOC_A,
+                                                Adafruit_PWMServoDriver_A
+                                        ) ;  
                      
                      
+                     //####
                      
+                     
+                     
+                     
+                      Slave_Ports_Status_A[TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX].DISPLAY_ELEMENT_TO_REFRESH_A = true;
+                      DISPLAY_PHYSICAL_CHAR_A.DISPLAY_ELEMENT_TO_REFRESH_A = true ;
+                      DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[  TASK_PORT_ASSOC_A.DISPLAY_MENU_INDEX_A  ].DISPLAY_MENU_ITEM_A[ TASK_PORT_ASSOC_A.DISPLAY_MENU_ITEM_INDEX_A ].DISPLAY_ELEMENT_TO_REFRESH_A = true ;
+                      DISPLAY_PHYSICAL_CHAR_A.DISPLAY_MENU_A[  TASK_PORT_ASSOC_A.DISPLAY_MENU_INDEX_A  ].DISPLAY_MENU_ITEM_A[ TASK_PORT_ASSOC_A.DISPLAY_MENU_ITEM_INDEX_A ].Exp_state_level_A = Exp_state_level_A ;
+
                                  Slave_Ports_Protocol_CAN_request_confirm_Exp_state_T CAN_request_confirm_Exp_state_A={};
                                     //CAN_request_confirm_Exp_state_A._CAN_REMOTE_ID = Slave_Ports_Status_A[TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX]._Slave_ID;
                                   //  CAN_broadcast_A._CAN_SENDER_ID = EEPROM_Active_ControllerID_read_A Active_ControllerID_HEX ;
@@ -133,7 +172,7 @@ Slave_Ports_Status_QUEUE_T* Slave_Ports_Status_QUEUE_A,
                     String message ; 
                     byte sndStat = CAN0.sendMsgBuf(Active_ControllerID_HEX , //Active_ControllerID_HEX, 
                         0, 8, CAN_MSG8_A_Slave_Ports_Protocol_CAN_request_confirm_Exp_state_A); 
-                    delay(200);
+                    delay(20);
                      if(sndStat == CAN_OK){
                      
                      // Slave_Ports_Status_A[TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX].Exp_state = Slave_Ports_Status_A[TASK_PORT_ASSOC_A.Slave_Ports_Status_T_INDEX].Exp_state |  Exp_state_SET_REQ_SEND ;

SE/stuff/P5_Automation_can-dev-res-working-1930/_TASK_TYPES_struct.h

@@ -39,6 +39,9 @@ struct TASK_PORT_ASSOC_S {
     Exp_state_level_T Exp_state_level_OLD_A;
     Exp_state_level_T Exp_state_level_NEW_A;
     Exp_state_level_T Exp_state_level_NEW_DELTA_A;
+    ARDUINO_ARRAY_ATTR_T DISPLAY_MENU_INDEX_A; //signal context
+    ARDUINO_ARRAY_ATTR_T DISPLAY_MENU_ITEM_INDEX_A ;//signal context
+
 } ; //To associate some port to TASK
 
 typedef struct TASK_PORT_ASSOC_S TASK_PORT_ASSOC_T ;

SE/stuff/P5_Automation_can-dev-res-working-1930/___loop/___loop_init.h

@@ -7,8 +7,8 @@
 
 
 
-    static ARDUINO_LOOP_LATENCY_T      ARDUINO_LOOP_LATENCY__MAIN_A = 50; //250 ; //EVERY 10 LOOPS INIT THIS LATENCY
-    static ARDUINO_LOOP_LATENCY_T     ARDUINO_LOOP_LATENCY__MAIN_END_A = 100;//500 ; //EVERY 10 LOOPS INIT THIS LATENCY
+    static ARDUINO_LOOP_LATENCY_T      ARDUINO_LOOP_LATENCY__MAIN_A = 20; //250 ; //EVERY 10 LOOPS INIT THIS LATENCY
+    static ARDUINO_LOOP_LATENCY_T     ARDUINO_LOOP_LATENCY__MAIN_END_A = 5; // 100;//500 ; //EVERY 10 LOOPS INIT THIS LATENCY
 
 
 

SE/stuff/P5_Automation_can-dev-res-working-1930/___loop/__main_loop_end.h

@@ -1,6 +1,27 @@
 
 //static ARDUINO_LOOP_LATENCY_T     ARDUINO_LOOP_LATENCY__MAIN_END_A = 10000 ; //EVERY 10 LOOPS INIT THIS LATENCY
-
+ _Slave_Ports_queue__POP(
+                     Slave_Ports_Status_QUEUE_A, 
+                     Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,
+                   /* GARBAGE_TO_REMOVE_ASSOC_EMPTY , //_Slave_Ports_queue_count, 
+                    GARBAGE_TO_REMOVE_ASSOC_EMPTY , //_Slave_Ports_queue_pop, 
+                    GARBAGE_TO_REMOVE_ASSOC_EMPTY , //_Slave_Ports_queue_front, 
+                    GARBAGE_TO_REMOVE_ASSOC_EMPTY, //_Slave_Ports_queue_back,
+                    GARBAGE_TO_REMOVE_ASSOC_EMPTY,// _Slave_Ports_queue_peek,
+                   */
+                    LCDtim, 
+                    
+                            Slave_Ports_Status_A ,
+                            Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A ,
+                            Slave_Ports_Status_T_ARDUINO_ARRAY_INDEX_TABLE_A,
+                             Slave_Ports_Status_T_ARDUINO_ARRAY_INDEX_T_TO_DELETE_A,
+                             Slave_Ports_Status_T_ARDUINO_ARRAY_ASSOC_TABLE_S_Port_ID_A
+                             ,
+                              DISPLAY_A , 
+                              DISPLAY_T_ARDUINO_ATTR_ARRAY_A,
+                              DISPLAY_PHYSICAL_CHAR_A,
+                               Adafruit_PWMServoDriver_A, 0 //time 
+             );
 
 if(ARDUINO_LOOP_LATENCY_COUNTER__MAIN_END(ARDUINO_LOOP_LATENCY__MAIN_END_A, ARDUINO_LOOP_LATENCY_CONTROL_FLAG_NONE ) <= ARDUINO_LOOP_LATENCY_COUNTER_INIT )  {
             #if defined(DEBUG_LATENCY_MARKER)
@@ -34,28 +55,7 @@ if(ARDUINO_LOOP_LATENCY_COUNTER__MAIN_END(ARDUINO_LOOP_LATENCY__MAIN_END_A, ARDU
                      Serial.println("] ");
                  }
                #endif
-             _Slave_Ports_queue__POP(
-                     Slave_Ports_Status_QUEUE_A, 
-                     Slave_Ports_Status_QUEUE_T_ARDUINO_ATTR_ARRAY_A ,
-                   /* GARBAGE_TO_REMOVE_ASSOC_EMPTY , //_Slave_Ports_queue_count, 
-                    GARBAGE_TO_REMOVE_ASSOC_EMPTY , //_Slave_Ports_queue_pop, 
-                    GARBAGE_TO_REMOVE_ASSOC_EMPTY , //_Slave_Ports_queue_front, 
-                    GARBAGE_TO_REMOVE_ASSOC_EMPTY, //_Slave_Ports_queue_back,
-                    GARBAGE_TO_REMOVE_ASSOC_EMPTY,// _Slave_Ports_queue_peek,
-                   */
-                    LCDtim, 
-                    
-                            Slave_Ports_Status_A ,
-                            Slave_Ports_Status_T_ARDUINO_ATTR_ARRAY_A ,
-                            Slave_Ports_Status_T_ARDUINO_ARRAY_INDEX_TABLE_A,
-                             Slave_Ports_Status_T_ARDUINO_ARRAY_INDEX_T_TO_DELETE_A,
-                             Slave_Ports_Status_T_ARDUINO_ARRAY_ASSOC_TABLE_S_Port_ID_A
-                             ,
-                              DISPLAY_A , 
-                              DISPLAY_T_ARDUINO_ATTR_ARRAY_A,
-                              DISPLAY_PHYSICAL_CHAR_A,
-                               Adafruit_PWMServoDriver_A, 0 //time 
-             );
+            
              
             #endif 
  
@@ -135,7 +135,7 @@ if(ARDUINO_LOOP_LATENCY_COUNTER__MAIN_END(ARDUINO_LOOP_LATENCY__MAIN_END_A, ARDU
                                 
         
                                 DISPLAY_DEV.print("P:"); DISPLAY_DEV.print(Port11); DISPLAY_DEV.print(" "); DISPLAY_DEV.print(digitalRead(Port11)); //DISPLAY_DEV.print(analogRead(Port11));
-                               // LCD_print_DISPLAY_MENU_A(DISPLAY_MENU_A__PROGMEM_CONSOLE_PRINT);
+                                LCD_print_DISPLAY_MENU_A(DISPLAY_MENU_A__PROGMEM_CONSOLE_PRINT);
                             }
                     #endif