ethernet: move dmac filtering to inline function

In eth_input_process_frame(), destination MAC addresses are
compared to the interface hardware address in a loop. Move
this to a separate inline function to facilitate making changes
to the filtering logic more cleanly.

Type: refactor

Change-Id: I0978f01667e78af5214dbbc9ba223f5b84ce6b7e
Signed-off-by: Matthew Smith <mgsmith@netgate.com>
(cherry picked from commit fa20d4c5375c02f61e565b5fc57c490145bc0919)

1 files changed, 63 insertions, 56 deletions

diff --git a/src/vnet/ethernet/node.c b/src/vnet/ethernet/node.c
index 272475938a9..ee14e40d881 100755
--- a/src/vnet/ethernet/node.c
+++ b/src/vnet/ethernet/node.c
@@ -608,6 +608,68 @@ eth_input_tag_lookup (vlib_main_t * vm, vnet_main_t * vnm,
   l->n_bytes += vlib_buffer_length_in_chain (vm, b);
 }
 
+static_always_inline void
+eth_input_process_frame_dmac_check (vnet_hw_interface_t * hi,
+				    u64 * dmacs, u8 * dmacs_bad,
+				    u32 n_packets)
+{
+  u64 mask = clib_net_to_host_u64 (0xFFFFFFFFFFFF0000);
+  u64 igbit = clib_net_to_host_u64 (0x0100000000000000);
+  u64 hwaddr = (*(u64 *) hi->hw_address) & mask;
+  u64 *dmac = dmacs;
+  u8 *dmac_bad = dmacs_bad;
+
+  i32 n_left = n_packets;
+
+#ifdef CLIB_HAVE_VEC256
+  u64x4 igbit4 = u64x4_splat (igbit);
+  u64x4 mask4 = u64x4_splat (mask);
+  u64x4 hwaddr4 = u64x4_splat (hwaddr);
+  while (n_left > 0)
+    {
+      u64x4 r0, r1;
+      r0 = u64x4_load_unaligned (dmac + 0) & mask4;
+      r1 = u64x4_load_unaligned (dmac + 4) & mask4;
+
+      r0 = (r0 != hwaddr4) & ((r0 & igbit4) == 0);
+      r1 = (r1 != hwaddr4) & ((r1 & igbit4) == 0);
+
+      *(u32 *) (dmac_bad + 0) = u8x32_msb_mask ((u8x32) (r0));
+      *(u32 *) (dmac_bad + 4) = u8x32_msb_mask ((u8x32) (r1));
+
+      /* next */
+      dmac += 8;
+      dmac_bad += 8;
+      n_left -= 8;
+    }
+#else
+  while (n_left > 0)
+    {
+      u64 r0, r1, r2, r3;
+
+      r0 = dmac[0] & mask;
+      r1 = dmac[1] & mask;
+      r2 = dmac[2] & mask;
+      r3 = dmac[3] & mask;
+
+      r0 = (r0 != hwaddr) && ((r0 & igbit) == 0);
+      r1 = (r1 != hwaddr) && ((r1 & igbit) == 0);
+      r2 = (r2 != hwaddr) && ((r2 & igbit) == 0);
+      r3 = (r3 != hwaddr) && ((r3 & igbit) == 0);
+
+      dmac_bad[0] = r0;
+      dmac_bad[1] = r1;
+      dmac_bad[2] = r2;
+      dmac_bad[3] = r3;
+
+      /* next */
+      dmac += 4;
+      dmac_bad += 4;
+      n_left -= 4;
+    }
+#endif
+}
+
 /* process frame of buffers, store ethertype into array and update
    buffer metadata fields depending on interface being l2 or l3 assuming that
    packets are untagged. For tagged packets those fields are updated later.
@@ -705,62 +767,7 @@ eth_input_process_frame (vlib_main_t * vm, vlib_node_runtime_t * node,
     }
 
   if (dmac_check)
-    {
-      u64 mask = clib_net_to_host_u64 (0xFFFFFFFFFFFF0000);
-      u64 igbit = clib_net_to_host_u64 (0x0100000000000000);
-      u64 hwaddr = (*(u64 *) hi->hw_address) & mask;
-      u64 *dmac = dmacs;
-      u8 *dmac_bad = dmacs_bad;
-
-      n_left = n_packets;
-
-#ifdef CLIB_HAVE_VEC256
-      u64x4 igbit4 = u64x4_splat (igbit);
-      u64x4 mask4 = u64x4_splat (mask);
-      u64x4 hwaddr4 = u64x4_splat (hwaddr);
-      while (n_left > 0)
-	{
-	  u64x4 r0, r1;
-	  r0 = u64x4_load_unaligned (dmac + 0) & mask4;
-	  r1 = u64x4_load_unaligned (dmac + 4) & mask4;
-
-	  r0 = (r0 != hwaddr4) & ((r0 & igbit4) == 0);
-	  r1 = (r1 != hwaddr4) & ((r1 & igbit4) == 0);
-
-	  *(u32 *) (dmac_bad + 0) = u8x32_msb_mask ((u8x32) (r0));
-	  *(u32 *) (dmac_bad + 4) = u8x32_msb_mask ((u8x32) (r1));
-
-	  /* next */
-	  dmac += 8;
-	  dmac_bad += 8;
-	  n_left -= 8;
-	}
-#else
-      while (n_left > 0)
-	{
-	  u64 r0, r1, r2, r3;
-	  r0 = dmac[0] & mask;
-	  r1 = dmac[1] & mask;
-	  r2 = dmac[2] & mask;
-	  r3 = dmac[3] & mask;
-
-	  r0 = (r0 != hwaddr) && ((r0 & igbit) == 0);
-	  r1 = (r1 != hwaddr) && ((r1 & igbit) == 0);
-	  r2 = (r2 != hwaddr) && ((r2 & igbit) == 0);
-	  r3 = (r3 != hwaddr) && ((r3 & igbit) == 0);
-
-	  dmac_bad[0] = r0;
-	  dmac_bad[1] = r1;
-	  dmac_bad[2] = r2;
-	  dmac_bad[3] = r3;
-
-	  /* next */
-	  dmac += 4;
-	  dmac_bad += 4;
-	  n_left -= 4;
-	}
-#endif
-    }
+    eth_input_process_frame_dmac_check (hi, dmacs, dmacs_bad, n_packets);
 
   next_ip4 = em->l3_next.input_next_ip4;
   next_ip6 = em->l3_next.input_next_ip6;