UDPSOCKET_ECHOTEST change to tolerate duplicate packets

Author: Marcin Tomczyk

TESTS/netsocket/udp/udpsocket_echotest.cpp

@@ -40,6 +40,7 @@ EventFlags signals;
 static const int BUFF_SIZE = 1200;
 char rx_buffer[BUFF_SIZE] = {0};
 char tx_buffer[BUFF_SIZE] = {0};
+char rx_last[BUFF_SIZE] = {0};
 
 static const int PKTS = 22;
 static const int pkt_sizes[PKTS] = {1, 2, 3, 4, 5, 6, 7, 8, 9, 10, \
@@ -68,6 +69,7 @@ void UDPSOCKET_ECHOTEST()
     int sent;
     int packets_sent = 0;
     int packets_recv = 0;
+    bool received_duplicate_packet = false;
     for (unsigned int s_idx = 0; s_idx < sizeof(pkt_sizes) / sizeof(*pkt_sizes); ++s_idx) {
         int pkt_s = pkt_sizes[s_idx];
 
@@ -76,6 +78,7 @@ void UDPSOCKET_ECHOTEST()
 
         for (int retry_cnt = 0; retry_cnt <= 2; retry_cnt++) {
             memset(rx_buffer, 0, BUFF_SIZE);
+            memset(rx_last, 0, BUFF_SIZE);
             sent = sock.sendto(udp_addr, tx_buffer, pkt_s);
             if (check_oversized_packets(sent, pkt_s)) {
                 TEST_IGNORE_MESSAGE("This device does not handle oversized packets");
@@ -85,7 +88,17 @@ void UDPSOCKET_ECHOTEST()
                 printf("[Round#%02d - Sender] error, returned %d\n", s_idx, sent);
                 continue;
             }
-            recvd = sock.recvfrom(NULL, rx_buffer, pkt_s);
+            
+            do {
+                received_duplicate_packet = false;
+                recvd = sock.recvfrom(NULL, rx_buffer, pkt_s);
+                //Check if received duplicated packet
+                if (s_idx > 0 && recvd == pkt_sizes[s_idx - 1] && memcmp(rx_last, rx_buffer, recvd) == 0) {
+                    printf("[Round#%02d - Receiver] info, received duplicate packet, returned %d\n", s_idx, recvd);
+                    received_duplicate_packet = true;
+                }
+            } while (received_duplicate_packet);
+
             if (recvd == pkt_s) {
                 break;
             } else {
@@ -94,6 +107,7 @@ void UDPSOCKET_ECHOTEST()
         }
         if (memcmp(tx_buffer, rx_buffer, pkt_s) == 0) {
             packets_recv++;
+            memcpy(rx_last, rx_buffer, pkt_s);
         }
         // Make sure that at least one packet of every size was sent.
         TEST_ASSERT_TRUE(packets_sent > packets_sent_prev);