Drop non eCPRI packets

trx_ecpri_dpdk.c

@@ -601,7 +601,7 @@ static void *recv_thread(void *p) {
         update_counter(&rx_drop_counter, nb_rx);
     }
     else {
-      int nc; int nr; int k = 0;
+      int nc; int nr; int k = 0; int drop_total = 0;
       nr = nb_rx;
       while((nc = rbuf_contiguous_copy(NULL, &rx_rbuf, nr))) {
 
@@ -617,6 +617,7 @@ static void *recv_thread(void *p) {
 
         buf = ((uint8_t *) rx_rbuf.buffer) + (rx_rbuf.write_index * rx_rbuf.len);
         for(int i = 0; i < nc; i++) {
+        int drop = 0;
 #ifdef DPDK
           rtebuf = (uint8_t *) (pkt[i + k])->buf_addr + (pkt[i + k])->data_off;
           if(first_seq_id) {
@@ -637,21 +638,30 @@ static void *recv_thread(void *p) {
             }
           }
 
-          if((pkt[i + k])->data_len != rx_rbuf.len)
+          if((pkt[i + k])->data_len != rx_rbuf.len) {
+            for(int j = 0; j < pkt[i + k]->data_len; j++) {
+              printf("%02x", rtebuf[j]);
+            }
+            printf("\n");
             log_error("RECV", "Packet data length (%d) != RX buffer len (%d)", pkt[i + k]->data_len, rx_rbuf.len);
+          }
+          if(ntohl((uint32_t) rtebuf + 12) != 0xaefe) {
+            drop++; drop_total++;
+            continue;
+          }
           memcpy(buf + i * rx_rbuf.len, rtebuf, rx_rbuf.len);
 #else
           //memcpy(buf + i * rx_rbuf.len, pkt_frame_full, rx_rbuf.len);
 #endif
         }
-        rx_rbuf.write_index = (rx_rbuf.write_index + nc) % rx_rbuf.buf_len;
+        rx_rbuf.write_index = (rx_rbuf.write_index + nc - drop) % rx_rbuf.buf_len;
         for(int i = 0; i < nc; i++)
           rte_pktmbuf_free(pkt[i + k]);
         nr -= nc;
         k += nc;
       }
     }
-    update_counter(&recv_counter, nb_rx);
+    update_counter(&recv_counter, nb_rx - drop_total);
 
   }
   pthread_exit(EXIT_SUCCESS);