[services] Fix filler allocation into condition loop

Author: TofMassilia13320

services/stsafea/stsafea_frame_transfer.c

@@ -182,10 +182,13 @@ stse_ReturnCode_t stsafea_frame_receive(stse_Handler_t *pSTSE, stse_frame_t *pFr
 
     /* Append filler frame element even if its length equal 0 */
     PLAT_UI8 filler[filler_size];
-    stse_frame_element_allocate_push(pFrame,
-                                     eFiller,
-                                     filler_size,
-                                     filler);
+    stse_frame_element_allocate(eFiller,
+                                filler_size,
+                                filler);
+    if (filler_size > 0) {
+        stse_frame_push_element(pFrame,
+                                &eFiller);
+    }
 
     /* ======================================================= */
     /* ========= Receive the frame in frame elements ========= */
@@ -301,7 +304,9 @@ stse_ReturnCode_t stsafea_frame_receive(stse_Handler_t *pSTSE, stse_frame_t *pFr
     }
 
     /* - Pop Filler element from Frame*/
-    stse_frame_pop_element(pFrame);
+    if (filler_size > 0) {
+        stse_frame_pop_element(pFrame);
+    }
 
     /* - Verify CRC */
     if (computed_crc != *(PLAT_UI16 *)received_crc) {

services/stsafel/stsafel_frame_transfer.c

@@ -164,11 +164,12 @@ stse_ReturnCode_t stsafel_i2c_frame_receive(stse_Handler_t *pSTSE, stse_frame_t
 
     /* Append filler frame element even if its length equal 0 */
     PLAT_UI8 filler[filler_size];
+    stse_frame_element_allocate(eFiller,
+                                filler_size,
+                                filler);
     if (filler_size > 0) {
-        stse_frame_element_allocate_push(pFrame,
-                                         eFiller,
-                                         filler_size,
-                                         filler);
+        stse_frame_push_element(pFrame,
+                                &eFiller);
     }
 
     /* ======================================================= */