Fix Allow ARP packets for dot1q interface with MACIP enabled
[vpp.git] / src / plugins / acl / acl.c
index 169dc12..e1d6da0 100644 (file)
@@ -76,7 +76,8 @@ _(MACIP_ACL_INTERFACE_ADD_DEL, macip_acl_interface_add_del) \
 _(MACIP_ACL_DUMP, macip_acl_dump) \
 _(MACIP_ACL_INTERFACE_GET, macip_acl_interface_get) \
 _(MACIP_ACL_INTERFACE_LIST_DUMP, macip_acl_interface_list_dump) \
-_(ACL_INTERFACE_SET_ETYPE_WHITELIST, acl_interface_set_etype_whitelist)
+_(ACL_INTERFACE_SET_ETYPE_WHITELIST, acl_interface_set_etype_whitelist) \
+_(ACL_INTERFACE_ETYPE_WHITELIST_DUMP, acl_interface_etype_whitelist_dump)
 
 
 /* *INDENT-OFF* */
@@ -1347,11 +1348,15 @@ typedef struct
   u32 arp_table_index;
   u32 dot1q_table_index;
   u32 dot1ad_table_index;
+  u32 arp_dot1q_table_index;
+  u32 arp_dot1ad_table_index;
   /* egress tables */
   u32 out_table_index;
   u32 out_arp_table_index;
   u32 out_dot1q_table_index;
   u32 out_dot1ad_table_index;
+  u32 out_arp_dot1q_table_index;
+  u32 out_arp_dot1ad_table_index;
 } macip_match_type_t;
 
 static u32
@@ -1472,10 +1477,14 @@ macip_create_classify_tables (acl_main_t * am, u32 macip_acl_index)
          mvec[match_type_index].arp_table_index = ~0;
          mvec[match_type_index].dot1q_table_index = ~0;
          mvec[match_type_index].dot1ad_table_index = ~0;
+         mvec[match_type_index].arp_dot1q_table_index = ~0;
+         mvec[match_type_index].arp_dot1ad_table_index = ~0;
          mvec[match_type_index].out_table_index = ~0;
          mvec[match_type_index].out_arp_table_index = ~0;
          mvec[match_type_index].out_dot1q_table_index = ~0;
          mvec[match_type_index].out_dot1ad_table_index = ~0;
+         mvec[match_type_index].out_arp_dot1q_table_index = ~0;
+         mvec[match_type_index].out_arp_dot1ad_table_index = ~0;
        }
       mvec[match_type_index].count++;
       mvec[match_type_index].has_egress |=
@@ -1491,6 +1500,10 @@ macip_create_classify_tables (acl_main_t * am, u32 macip_acl_index)
   {
     int mask_len;
     int is6 = mt->is_ipv6;
+    int tags;
+    u32 *last_tag_table;
+    u32 *out_last_tag_table;
+    u32 l3_offset;
 
     if (!is6)
       {
@@ -1521,41 +1534,91 @@ macip_create_classify_tables (acl_main_t * am, u32 macip_acl_index)
           |                               |
           +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+
         */
-       memset (mask, 0, sizeof (mask));
-       /* source MAC address */
-       memcpy (&mask[6], mt->mac_mask, 6);
-       memset (&mask[12], 0xff, 2);    /* ethernet protocol */
-       /* sender hardware address within ARP */
-       memcpy (&mask[14 + 8], mt->mac_mask, 6);
-       /* sender protocol address within ARP */
-       for (i = 0; i < (mt->prefix_len / 8); i++)
-         mask[14 + 14 + i] = 0xff;
-       if (mt->prefix_len % 8)
-         mask[14 + 14 + (mt->prefix_len / 8)] =
-           0xff - ((1 << (8 - mt->prefix_len % 8)) - 1);
-
-       mask_len = ((14 + 14 + ((mt->prefix_len + 7) / 8) +
-                    (sizeof (u32x4) - 1)) / sizeof (u32x4)) * sizeof (u32x4);
-       acl_classify_add_del_table_small (cm, mask, mask_len, last_table,
-                                         (~0 == last_table) ? 0 : ~0,
-                                         &mt->arp_table_index, 1);
-       last_table = mt->arp_table_index;
-       if (mt->has_egress)
+       for (tags = 2; tags >= 0; tags--)
          {
-           /* egress ARP table */
            memset (mask, 0, sizeof (mask));
-           // memcpy (&mask[0], mt->mac_mask, 6);
-           memset (&mask[12], 0xff, 2);        /* ethernet protocol */
-           /* AYXX: FIXME here - can we tighten the ARP-related table more ? */
-           /* mask captures just the destination and the ethertype */
-           mask_len = ((14 +
+           /* source MAC address */
+           memcpy (&mask[6], mt->mac_mask, 6);
+
+           switch (tags)
+             {
+             case 0:
+             default:
+               memset (&mask[12], 0xff, 2);    /* ethernet protocol */
+               l3_offset = 14;
+               last_tag_table = &mt->arp_table_index;
+               break;
+             case 1:
+               memset (&mask[12], 0xff, 2);    /* VLAN tag1 */
+               memset (&mask[16], 0xff, 2);    /* ethernet protocol */
+               l3_offset = 18;
+               last_tag_table = &mt->arp_dot1q_table_index;
+               break;
+             case 2:
+               memset (&mask[12], 0xff, 2);    /* VLAN tag1 */
+               memset (&mask[16], 0xff, 2);    /* VLAN tag2 */
+               memset (&mask[20], 0xff, 2);    /* ethernet protocol */
+               l3_offset = 22;
+               last_tag_table = &mt->arp_dot1ad_table_index;
+               break;
+             }
+
+           /* sender hardware address within ARP */
+           memcpy (&mask[l3_offset + 8], mt->mac_mask, 6);
+           /* sender protocol address within ARP */
+           for (i = 0; i < (mt->prefix_len / 8); i++)
+             mask[l3_offset + 14 + i] = 0xff;
+           if (mt->prefix_len % 8)
+             mask[l3_offset + 14 + (mt->prefix_len / 8)] =
+               0xff - ((1 << (8 - mt->prefix_len % 8)) - 1);
+
+           mask_len = ((l3_offset + 14 + ((mt->prefix_len + 7) / 8) +
                         (sizeof (u32x4) -
                          1)) / sizeof (u32x4)) * sizeof (u32x4);
-           acl_classify_add_del_table_small (cm, mask, mask_len,
-                                             out_last_table,
-                                             (~0 == out_last_table) ? 0 : ~0,
-                                             &mt->out_arp_table_index, 1);
-           out_last_table = mt->out_arp_table_index;
+           acl_classify_add_del_table_small (cm, mask, mask_len, last_table,
+                                             (~0 == last_table) ? 0 : ~0,
+                                             last_tag_table, 1);
+           last_table = *last_tag_table;
+           if (mt->has_egress)
+             {
+               /* egress ARP table */
+               memset (mask, 0, sizeof (mask));
+
+               switch (tags)
+                 {
+                 case 0:
+                 default:
+                   memset (&mask[12], 0xff, 2);        /* ethernet protocol */
+                   l3_offset = 14;
+                   out_last_tag_table = &mt->out_arp_table_index;
+                   break;
+                 case 1:
+                   memset (&mask[12], 0xff, 2);        /* VLAN tag1 */
+                   memset (&mask[16], 0xff, 2);        /* ethernet protocol */
+                   l3_offset = 18;
+                   out_last_tag_table = &mt->out_arp_dot1q_table_index;
+                   break;
+                 case 2:
+                   memset (&mask[12], 0xff, 2);        /* VLAN tag1 */
+                   memset (&mask[16], 0xff, 2);        /* VLAN tag2 */
+                   memset (&mask[20], 0xff, 2);        /* ethernet protocol */
+                   l3_offset = 22;
+                   out_last_tag_table = &mt->out_arp_dot1ad_table_index;
+                   break;
+                 }
+
+               /* AYXX: FIXME here - can we tighten the ARP-related table more ? */
+               /* mask captures just the destination and the ethertype */
+               mask_len = ((l3_offset +
+                            (sizeof (u32x4) -
+                             1)) / sizeof (u32x4)) * sizeof (u32x4);
+               acl_classify_add_del_table_small (cm, mask, mask_len,
+                                                 out_last_table,
+                                                 (~0 ==
+                                                  out_last_table) ? 0 : ~0,
+                                                 out_last_tag_table, 1);
+               out_last_table = *out_last_tag_table;
+             }
          }
       }
   }
@@ -1745,15 +1808,45 @@ macip_create_classify_tables (acl_main_t * am, u32 macip_acl_index)
        {
          memset (mask, 0, sizeof (mask));
          memcpy (&mask[6], a->rules[i].src_mac, 6);
-         mask[12] = 0x08;
-         mask[13] = 0x06;
-         memcpy (&mask[14 + 8], a->rules[i].src_mac, 6);
-         memcpy (&mask[14 + 14], &a->rules[i].src_ip_addr.ip4, 4);
-         vnet_classify_add_del_session (cm,
-                                        mvec
-                                        [match_type_index].arp_table_index,
-                                        mask, a->rules[i].is_permit ? ~0 : 0,
-                                        i, 0, action, metadata, 1);
+
+         for (tags = 2; tags >= 0; tags--)
+           {
+             switch (tags)
+               {
+               case 0:
+               default:
+                 tag_table = mvec[match_type_index].arp_table_index;
+                 mask[12] = 0x08;
+                 mask[13] = 0x06;
+                 l3_src_offs = 14;
+                 break;
+               case 1:
+                 tag_table = mvec[match_type_index].arp_dot1q_table_index;
+                 mask[12] = 0x81;
+                 mask[13] = 0x00;
+                 mask[16] = 0x08;
+                 mask[17] = 0x06;
+                 l3_src_offs = 18;
+                 break;
+               case 2:
+                 tag_table = mvec[match_type_index].arp_dot1ad_table_index;
+                 mask[12] = 0x88;
+                 mask[13] = 0xa8;
+                 mask[16] = 0x81;
+                 mask[17] = 0x00;
+                 mask[20] = 0x08;
+                 mask[21] = 0x06;
+                 l3_src_offs = 22;
+                 break;
+               }
+
+             memcpy (&mask[l3_src_offs + 8], a->rules[i].src_mac, 6);
+             memcpy (&mask[l3_src_offs + 14], &a->rules[i].src_ip_addr.ip4,
+                     4);
+             vnet_classify_add_del_session (cm, tag_table, mask,
+                                            a->rules[i].is_permit ? ~0 : 0,
+                                            i, 0, action, metadata, 1);
+           }
        }
       if (macip_permit_also_egress (a->rules[i].is_permit))
        {
@@ -1812,16 +1905,43 @@ macip_create_classify_tables (acl_main_t * am, u32 macip_acl_index)
          /* add ARP table entry too */
          if (!is6 && (mvec[match_type_index].out_arp_table_index != ~0))
            {
-             memset (mask, 0, sizeof (mask));
-             memcpy (&mask[0], a->rules[i].src_mac, 6);
-             mask[12] = 0x08;
-             mask[13] = 0x06;
-             vnet_classify_add_del_session (cm,
-                                            mvec
-                                            [match_type_index].out_arp_table_index,
-                                            mask,
-                                            a->rules[i].is_permit ? ~0 : 0,
-                                            i, 0, action, metadata, 1);
+             for (tags = 2; tags >= 0; tags--)
+               {
+                 memset (mask, 0, sizeof (mask));
+                 switch (tags)
+                   {
+                   case 0:
+                   default:
+                     tag_table = mvec[match_type_index].out_arp_table_index;
+                     mask[12] = 0x08;
+                     mask[13] = 0x06;
+                     break;
+                   case 1:
+                     tag_table =
+                       mvec[match_type_index].out_arp_dot1q_table_index;
+                     mask[12] = 0x81;
+                     mask[13] = 0x00;
+                     mask[16] = 0x08;
+                     mask[17] = 0x06;
+                     break;
+                   case 2:
+                     tag_table =
+                       mvec[match_type_index].out_arp_dot1ad_table_index;
+                     mask[12] = 0x88;
+                     mask[13] = 0xa8;
+                     mask[16] = 0x81;
+                     mask[17] = 0x00;
+                     mask[20] = 0x08;
+                     mask[21] = 0x06;
+                     break;
+                   }
+
+                 vnet_classify_add_del_session (cm, tag_table,
+                                                mask,
+                                                a->
+                                                rules[i].is_permit ? ~0 : 0,
+                                                i, 0, action, metadata, 1);
+               }
            }
        }
     }
@@ -2696,6 +2816,98 @@ static void
   REPLY_MACRO (VL_API_ACL_INTERFACE_SET_ETYPE_WHITELIST_REPLY);
 }
 
+static void
+send_acl_interface_etype_whitelist_details (acl_main_t * am,
+                                           vl_api_registration_t * reg,
+                                           u32 sw_if_index, u32 context)
+{
+  vl_api_acl_interface_etype_whitelist_details_t *mp;
+  int msg_size;
+  int n_input = 0;
+  int n_output = 0;
+  int count = 0;
+  int i = 0;
+
+  u16 *whitelist_in = 0;
+  u16 *whitelist_out = 0;
+
+  if (intf_has_etype_whitelist (am, sw_if_index, 0))
+    whitelist_out =
+      vec_elt (am->output_etype_whitelist_by_sw_if_index, sw_if_index);
+
+  if (intf_has_etype_whitelist (am, sw_if_index, 1))
+    whitelist_in =
+      vec_elt (am->input_etype_whitelist_by_sw_if_index, sw_if_index);
+
+  if ((0 == whitelist_in) && (0 == whitelist_out))
+    return;                    /* nothing to do */
+
+  void *oldheap = acl_set_heap (am);
+
+  n_input = vec_len (whitelist_in);
+  n_output = vec_len (whitelist_out);
+  count = n_input + n_output;
+
+  msg_size = sizeof (*mp);
+  msg_size += sizeof (mp->whitelist[0]) * count;
+
+  mp = vl_msg_api_alloc (msg_size);
+  memset (mp, 0, msg_size);
+  mp->_vl_msg_id =
+    ntohs (VL_API_ACL_INTERFACE_ETYPE_WHITELIST_DETAILS + am->msg_id_base);
+
+  /* fill in the message */
+  mp->context = context;
+  mp->sw_if_index = htonl (sw_if_index);
+  mp->count = count;
+  mp->n_input = n_input;
+  for (i = 0; i < n_input; i++)
+    {
+      mp->whitelist[i] = htons (whitelist_in[i]);
+    }
+  for (i = 0; i < n_output; i++)
+    {
+      mp->whitelist[n_input + i] = htons (whitelist_out[i]);
+    }
+  clib_mem_set_heap (oldheap);
+  vl_api_send_msg (reg, (u8 *) mp);
+}
+
+
+static void
+  vl_api_acl_interface_etype_whitelist_dump_t_handler
+  (vl_api_acl_interface_list_dump_t * mp)
+{
+  acl_main_t *am = &acl_main;
+  vnet_sw_interface_t *swif;
+  vnet_interface_main_t *im = &am->vnet_main->interface_main;
+
+  u32 sw_if_index;
+  vl_api_registration_t *reg;
+
+  reg = vl_api_client_index_to_registration (mp->client_index);
+  if (!reg)
+    return;
+
+  if (mp->sw_if_index == ~0)
+    {
+    /* *INDENT-OFF* */
+    pool_foreach (swif, im->sw_interfaces,
+    ({
+      send_acl_interface_etype_whitelist_details(am, reg, swif->sw_if_index, mp->context);
+    }));
+    /* *INDENT-ON* */
+    }
+  else
+    {
+      sw_if_index = ntohl (mp->sw_if_index);
+      if (!pool_is_free_index (im->sw_interfaces, sw_if_index))
+       send_acl_interface_etype_whitelist_details (am, reg, sw_if_index,
+                                                   mp->context);
+    }
+}
+
+
 
 /* Set up the API message handling tables */
 static clib_error_t *