Implemented full e2e testing

Source/Components/Interfaces/DebugService/DebugService.cpp

@@ -520,6 +520,10 @@ ErrorManagement::ErrorType DebugService::Streamer(ExecutionInfo &info) {
 
     // b) Drain traceBuffer — pack each sample into udpsDataPayload
     bool anyData = false;
+    bool pendingInDrain[UDPS_MAX_SLOTS];
+    for (uint32 i = 0u; i < udpsNumSlots; i++) {
+        pendingInDrain[i] = false;
+    }
     uint32 id, size;
     uint64 ts;
     uint8  udpsSampleBuf[UDPS_MAX_SAMPLE_BYTES];
@@ -528,6 +532,18 @@ ErrorManagement::ErrorType DebugService::Streamer(ExecutionInfo &info) {
         // Find matching slot by internalID
         for (uint32 i = 0u; i < udpsNumSlots; i++) {
             if (udpsSlots[i].internalID == id) {
+                if (pendingInDrain[i]) {
+                    // This slot already holds an unflushed sample from earlier
+                    // in this same drain pass — flush it now instead of
+                    // silently overwriting it, or lossless tracing would drop
+                    // a real sample whenever the Streamer thread falls behind
+                    // by more than one RT cycle.
+                    FlushUdpsFrame();
+                    for (uint32 j = 0u; j < udpsNumSlots; j++) {
+                        pendingInDrain[j] = false;
+                    }
+                    anyData = false;
+                }
                 if ((udpsDataPayload != NULL_PTR(uint8 *)) &&
                     (8u + udpsSlots[i].wireOffset + udpsSlots[i].wireSize <= udpsDataPayloadSize)) {
                     uint32 copySize = size;
@@ -535,6 +551,7 @@ ErrorManagement::ErrorType DebugService::Streamer(ExecutionInfo &info) {
                     memcpy(udpsDataPayload + 8u + udpsSlots[i].wireOffset, udpsSampleBuf, copySize);
                     udpsSlots[i].everFilled = true;
                 }
+                pendingInDrain[i] = true;
                 anyData = true;
                 break;
             }
@@ -542,18 +559,22 @@ ErrorManagement::ErrorType DebugService::Streamer(ExecutionInfo &info) {
     }
 
     // c) If we have data, stamp with HRT and send via udpsServer
-    if (anyData && udpsNumSlots > 0u && udpsDataPayload != NULL_PTR(uint8 *)) {
+    if (anyData) {
+        FlushUdpsFrame();
+    } else {
+        Sleep::MSec(1u);
+    }
+
+    return ErrorManagement::NoError;
+}
+
+void DebugService::FlushUdpsFrame() {
+    if (udpsNumSlots > 0u && udpsDataPayload != NULL_PTR(uint8 *)) {
         uint64 hrt = HighResolutionTimer::Counter();
         memcpy(udpsDataPayload, &hrt, 8u);
         udpsPacketCounter++;
         (void)udpsServer.SendData(udpsPacketCounter, udpsDataPayload, udpsDataPayloadSize);
     }
-
-    if (!anyData) {
-        Sleep::MSec(1u);
-    }
-
-    return ErrorManagement::NoError;
 }
 
 // ---------------------------------------------------------------------------