src/vnet/ethernet/node.c

   1 /*
   2  * Copyright (c) 2015 Cisco and/or its affiliates.
   3  * Licensed under the Apache License, Version 2.0 (the "License");
   4  * you may not use this file except in compliance with the License.
   5  * You may obtain a copy of the License at:
   6  *
   7  *     http://www.apache.org/licenses/LICENSE-2.0
   8  *
   9  * Unless required by applicable law or agreed to in writing, software
  10  * distributed under the License is distributed on an "AS IS" BASIS,
  11  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  12  * See the License for the specific language governing permissions and
  13  * limitations under the License.
  14  */
  15 /*
  16  * ethernet_node.c: ethernet packet processing
  17  *
  18  * Copyright (c) 2008 Eliot Dresselhaus
  19  *
  20  * Permission is hereby granted, free of charge, to any person obtaining
  21  * a copy of this software and associated documentation files (the
  22  * "Software"), to deal in the Software without restriction, including
  23  * without limitation the rights to use, copy, modify, merge, publish,
  24  * distribute, sublicense, and/or sell copies of the Software, and to
  25  * permit persons to whom the Software is furnished to do so, subject to
  26  * the following conditions:
  27  *
  28  * The above copyright notice and this permission notice shall be
  29  * included in all copies or substantial portions of the Software.
  30  *
  31  *  THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  32  *  EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  33  *  MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  34  *  NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
  35  *  LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
  36  *  OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
  37  *  WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
  38  */
  39
  40 #include <vlib/vlib.h>
  41 #include <vnet/pg/pg.h>
  42 #include <vnet/ethernet/ethernet.h>
  43 #include <vnet/ethernet/p2p_ethernet.h>
  44 #include <vppinfra/sparse_vec.h>
  45 #include <vnet/l2/l2_bvi.h>
  46
  47
  48 #define foreach_ethernet_input_next             \
  49   _ (PUNT, "error-punt")                        \
  50   _ (DROP, "error-drop")                        \
  51   _ (LLC, "llc-input")
  52
  53 typedef enum
  54 {
  55 #define _(s,n) ETHERNET_INPUT_NEXT_##s,
  56   foreach_ethernet_input_next
  57 #undef _
  58     ETHERNET_INPUT_N_NEXT,
  59 } ethernet_input_next_t;
  60
  61 typedef struct
  62 {
  63   u8 packet_data[32];
  64 } ethernet_input_trace_t;
  65
  66 static u8 *
  67 format_ethernet_input_trace (u8 * s, va_list * va)
  68 {
  69   CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *);
  70   CLIB_UNUSED (vlib_node_t * node) = va_arg (*va, vlib_node_t *);
  71   ethernet_input_trace_t *t = va_arg (*va, ethernet_input_trace_t *);
  72
  73   s = format (s, "%U", format_ethernet_header, t->packet_data);
  74
  75   return s;
  76 }
  77
  78 vlib_node_registration_t ethernet_input_node;
  79
  80 typedef enum
  81 {
  82   ETHERNET_INPUT_VARIANT_ETHERNET,
  83   ETHERNET_INPUT_VARIANT_ETHERNET_TYPE,
  84   ETHERNET_INPUT_VARIANT_NOT_L2,
  85 } ethernet_input_variant_t;
  86
  87
  88 // Parse the ethernet header to extract vlan tags and innermost ethertype
  89 static_always_inline void
  90 parse_header (ethernet_input_variant_t variant,
  91               vlib_buffer_t * b0,
  92               u16 * type,
  93               u16 * orig_type,
  94               u16 * outer_id, u16 * inner_id, u32 * match_flags)
  95 {
  96   u8 vlan_count;
  97
  98   if (variant == ETHERNET_INPUT_VARIANT_ETHERNET
  99       || variant == ETHERNET_INPUT_VARIANT_NOT_L2)
 100     {
 101       ethernet_header_t *e0;
 102
 103       e0 = (void *) (b0->data + b0->current_data);
 104
 105       vnet_buffer (b0)->l2_hdr_offset = b0->current_data;
 106
 107       vlib_buffer_advance (b0, sizeof (e0[0]));
 108
 109       *type = clib_net_to_host_u16 (e0->type);
 110     }
 111   else if (variant == ETHERNET_INPUT_VARIANT_ETHERNET_TYPE)
 112     {
 113       // here when prior node was LLC/SNAP processing
 114       u16 *e0;
 115
 116       e0 = (void *) (b0->data + b0->current_data);
 117
 118       vlib_buffer_advance (b0, sizeof (e0[0]));
 119
 120       *type = clib_net_to_host_u16 (e0[0]);
 121     }
 122
 123   // save for distinguishing between dot1q and dot1ad later
 124   *orig_type = *type;
 125
 126   // default the tags to 0 (used if there is no corresponding tag)
 127   *outer_id = 0;
 128   *inner_id = 0;
 129
 130   *match_flags = SUBINT_CONFIG_VALID | SUBINT_CONFIG_MATCH_0_TAG;
 131   vlan_count = 0;
 132
 133   // check for vlan encaps
 134   if (ethernet_frame_is_tagged (*type))
 135     {
 136       ethernet_vlan_header_t *h0;
 137       u16 tag;
 138
 139       *match_flags = SUBINT_CONFIG_VALID | SUBINT_CONFIG_MATCH_1_TAG;
 140
 141       h0 = (void *) (b0->data + b0->current_data);
 142
 143       tag = clib_net_to_host_u16 (h0->priority_cfi_and_id);
 144
 145       *outer_id = tag & 0xfff;
 146       if (0 == *outer_id)
 147         *match_flags &= ~SUBINT_CONFIG_MATCH_1_TAG;
 148
 149       *type = clib_net_to_host_u16 (h0->type);
 150
 151       vlib_buffer_advance (b0, sizeof (h0[0]));
 152       vlan_count = 1;
 153
 154       if (*type == ETHERNET_TYPE_VLAN)
 155         {
 156           // Double tagged packet
 157           *match_flags = SUBINT_CONFIG_VALID | SUBINT_CONFIG_MATCH_2_TAG;
 158
 159           h0 = (void *) (b0->data + b0->current_data);
 160
 161           tag = clib_net_to_host_u16 (h0->priority_cfi_and_id);
 162
 163           *inner_id = tag & 0xfff;
 164
 165           *type = clib_net_to_host_u16 (h0->type);
 166
 167           vlib_buffer_advance (b0, sizeof (h0[0]));
 168           vlan_count = 2;
 169           if (*type == ETHERNET_TYPE_VLAN)
 170             {
 171               // More than double tagged packet
 172               *match_flags = SUBINT_CONFIG_VALID | SUBINT_CONFIG_MATCH_3_TAG;
 173
 174               vlib_buffer_advance (b0, sizeof (h0[0]));
 175               vlan_count = 3;   // "unknown" number, aka, 3-or-more
 176             }
 177         }
 178     }
 179   ethernet_buffer_set_vlan_count (b0, vlan_count);
 180 }
 181
 182 // Determine the subinterface for this packet, given the result of the
 183 // vlan table lookups and vlan header parsing. Check the most specific
 184 // matches first.
 185 static_always_inline void
 186 identify_subint (vnet_hw_interface_t * hi,
 187                  vlib_buffer_t * b0,
 188                  u32 match_flags,
 189                  main_intf_t * main_intf,
 190                  vlan_intf_t * vlan_intf,
 191                  qinq_intf_t * qinq_intf,
 192                  u32 * new_sw_if_index, u8 * error0, u32 * is_l2)
 193 {
 194   u32 matched;
 195
 196   matched = eth_identify_subint (hi, b0, match_flags,
 197                                  main_intf, vlan_intf, qinq_intf,
 198                                  new_sw_if_index, error0, is_l2);
 199
 200   if (matched)
 201     {
 202
 203       // Perform L3 my-mac filter
 204       // A unicast packet arriving on an L3 interface must have a dmac matching the interface mac.
 205       // This is required for promiscuous mode, else we will forward packets we aren't supposed to.
 206       if (!(*is_l2))
 207         {
 208           ethernet_header_t *e0;
 209           e0 = (void *) (b0->data + vnet_buffer (b0)->l2_hdr_offset);
 210
 211           if (!(ethernet_address_cast (e0->dst_address)))
 212             {
 213               if (!eth_mac_equal ((u8 *) e0, hi->hw_address))
 214                 {
 215                   *error0 = ETHERNET_ERROR_L3_MAC_MISMATCH;
 216                 }
 217             }
 218         }
 219
 220       // Check for down subinterface
 221       *error0 = (*new_sw_if_index) != ~0 ? (*error0) : ETHERNET_ERROR_DOWN;
 222     }
 223 }
 224
 225 static_always_inline void
 226 determine_next_node (ethernet_main_t * em,
 227                      ethernet_input_variant_t variant,
 228                      u32 is_l20,
 229                      u32 type0, vlib_buffer_t * b0, u8 * error0, u8 * next0)
 230 {
 231   if (PREDICT_FALSE (*error0 != ETHERNET_ERROR_NONE))
 232     {
 233       // some error occurred
 234       *next0 = ETHERNET_INPUT_NEXT_DROP;
 235     }
 236   else if (is_l20)
 237     {
 238       *next0 = em->l2_next;
 239       // record the L2 len and reset the buffer so the L2 header is preserved
 240       u32 eth_start = vnet_buffer (b0)->l2_hdr_offset;
 241       vnet_buffer (b0)->l2.l2_len = b0->current_data - eth_start;
 242       ASSERT (vnet_buffer (b0)->l2.l2_len ==
 243               ethernet_buffer_header_size (b0));
 244       vlib_buffer_advance (b0, -ethernet_buffer_header_size (b0));
 245
 246       // check for common IP/MPLS ethertypes
 247     }
 248   else if (type0 == ETHERNET_TYPE_IP4)
 249     {
 250       *next0 = em->l3_next.input_next_ip4;
 251     }
 252   else if (type0 == ETHERNET_TYPE_IP6)
 253     {
 254       *next0 = em->l3_next.input_next_ip6;
 255     }
 256   else if (type0 == ETHERNET_TYPE_MPLS)
 257     {
 258       *next0 = em->l3_next.input_next_mpls;
 259
 260     }
 261   else if (em->redirect_l3)
 262     {
 263       // L3 Redirect is on, the cached common next nodes will be
 264       // pointing to the redirect node, catch the uncommon types here
 265       *next0 = em->redirect_l3_next;
 266     }
 267   else
 268     {
 269       // uncommon ethertype, check table
 270       u32 i0;
 271       i0 = sparse_vec_index (em->l3_next.input_next_by_type, type0);
 272       *next0 = vec_elt (em->l3_next.input_next_by_type, i0);
 273       *error0 =
 274         i0 ==
 275         SPARSE_VEC_INVALID_INDEX ? ETHERNET_ERROR_UNKNOWN_TYPE : *error0;
 276
 277       // The table is not populated with LLC values, so check that now.
 278       // If variant is variant_ethernet then we came from LLC processing. Don't
 279       // go back there; drop instead using by keeping the drop/bad table result.
 280       if ((type0 < 0x600) && (variant == ETHERNET_INPUT_VARIANT_ETHERNET))
 281         {
 282           *next0 = ETHERNET_INPUT_NEXT_LLC;
 283         }
 284     }
 285 }
 286
 287 static_always_inline int
 288 ethernet_frame_is_any_tagged (u16 type0, u16 type1)
 289 {
 290 #if __SSE4_2__
 291   const __m128i ethertype_mask = _mm_set_epi16 (ETHERNET_TYPE_VLAN,
 292                                                 ETHERNET_TYPE_DOT1AD,
 293                                                 ETHERNET_TYPE_VLAN_9100,
 294                                                 ETHERNET_TYPE_VLAN_9200,
 295                                                 /* duplicate for type1 */
 296                                                 ETHERNET_TYPE_VLAN,
 297                                                 ETHERNET_TYPE_DOT1AD,
 298                                                 ETHERNET_TYPE_VLAN_9100,
 299                                                 ETHERNET_TYPE_VLAN_9200);
 300
 301   __m128i r =
 302     _mm_set_epi16 (type0, type0, type0, type0, type1, type1, type1, type1);
 303   r = _mm_cmpeq_epi16 (ethertype_mask, r);
 304   return !_mm_test_all_zeros (r, r);
 305 #else
 306   return ethernet_frame_is_tagged (type0) || ethernet_frame_is_tagged (type1);
 307 #endif
 308 }
 309
 310 static_always_inline uword
 311 ethernet_input_inline (vlib_main_t * vm,
 312                        vlib_node_runtime_t * node,
 313                        vlib_frame_t * from_frame,
 314                        ethernet_input_variant_t variant)
 315 {
 316   vnet_main_t *vnm = vnet_get_main ();
 317   ethernet_main_t *em = &ethernet_main;
 318   vlib_node_runtime_t *error_node;
 319   u32 n_left_from, next_index, *from, *to_next;
 320   u32 stats_sw_if_index, stats_n_packets, stats_n_bytes;
 321   u32 thread_index = vlib_get_thread_index ();
 322   u32 cached_sw_if_index = ~0;
 323   u32 cached_is_l2 = 0;         /* shut up gcc */
 324   vnet_hw_interface_t *hi = NULL;       /* used for main interface only */
 325
 326   if (variant != ETHERNET_INPUT_VARIANT_ETHERNET)
 327     error_node = vlib_node_get_runtime (vm, ethernet_input_node.index);
 328   else
 329     error_node = node;
 330
 331   from = vlib_frame_vector_args (from_frame);
 332   n_left_from = from_frame->n_vectors;
 333
 334   if (node->flags & VLIB_NODE_FLAG_TRACE)
 335     vlib_trace_frame_buffers_only (vm, node,
 336                                    from,
 337                                    n_left_from,
 338                                    sizeof (from[0]),
 339                                    sizeof (ethernet_input_trace_t));
 340
 341   next_index = node->cached_next_index;
 342   stats_sw_if_index = node->runtime_data[0];
 343   stats_n_packets = stats_n_bytes = 0;
 344
 345   while (n_left_from > 0)
 346     {
 347       u32 n_left_to_next;
 348
 349       vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
 350
 351       while (n_left_from >= 4 && n_left_to_next >= 2)
 352         {
 353           u32 bi0, bi1;
 354           vlib_buffer_t *b0, *b1;
 355           u8 next0, next1, error0, error1;
 356           u16 type0, orig_type0, type1, orig_type1;
 357           u16 outer_id0, inner_id0, outer_id1, inner_id1;
 358           u32 match_flags0, match_flags1;
 359           u32 old_sw_if_index0, new_sw_if_index0, len0, old_sw_if_index1,
 360             new_sw_if_index1, len1;
 361           vnet_hw_interface_t *hi0, *hi1;
 362           main_intf_t *main_intf0, *main_intf1;
 363           vlan_intf_t *vlan_intf0, *vlan_intf1;
 364           qinq_intf_t *qinq_intf0, *qinq_intf1;
 365           u32 is_l20, is_l21;
 366           ethernet_header_t *e0, *e1;
 367
 368           /* Prefetch next iteration. */
 369           {
 370             vlib_buffer_t *b2, *b3;
 371
 372             b2 = vlib_get_buffer (vm, from[2]);
 373             b3 = vlib_get_buffer (vm, from[3]);
 374
 375             vlib_prefetch_buffer_header (b2, STORE);
 376             vlib_prefetch_buffer_header (b3, STORE);
 377
 378             CLIB_PREFETCH (b2->data, sizeof (ethernet_header_t), LOAD);
 379             CLIB_PREFETCH (b3->data, sizeof (ethernet_header_t), LOAD);
 380           }
 381
 382           bi0 = from[0];
 383           bi1 = from[1];
 384           to_next[0] = bi0;
 385           to_next[1] = bi1;
 386           from += 2;
 387           to_next += 2;
 388           n_left_to_next -= 2;
 389           n_left_from -= 2;
 390
 391           b0 = vlib_get_buffer (vm, bi0);
 392           b1 = vlib_get_buffer (vm, bi1);
 393
 394           error0 = error1 = ETHERNET_ERROR_NONE;
 395           e0 = vlib_buffer_get_current (b0);
 396           type0 = clib_net_to_host_u16 (e0->type);
 397           e1 = vlib_buffer_get_current (b1);
 398           type1 = clib_net_to_host_u16 (e1->type);
 399
 400           /* Speed-path for the untagged case */
 401           if (PREDICT_TRUE (variant == ETHERNET_INPUT_VARIANT_ETHERNET
 402                             && !ethernet_frame_is_any_tagged (type0, type1)))
 403             {
 404               main_intf_t *intf0;
 405               subint_config_t *subint0;
 406               u32 sw_if_index0, sw_if_index1;
 407
 408               sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
 409               sw_if_index1 = vnet_buffer (b1)->sw_if_index[VLIB_RX];
 410               is_l20 = cached_is_l2;
 411
 412               /* This is probably wholly unnecessary */
 413               if (PREDICT_FALSE (sw_if_index0 != sw_if_index1))
 414                 goto slowpath;
 415
 416               /* Now sw_if_index0 == sw_if_index1  */
 417               if (PREDICT_FALSE (cached_sw_if_index != sw_if_index0))
 418                 {
 419                   cached_sw_if_index = sw_if_index0;
 420                   hi = vnet_get_sup_hw_interface (vnm, sw_if_index0);
 421                   intf0 = vec_elt_at_index (em->main_intfs, hi->hw_if_index);
 422                   subint0 = &intf0->untagged_subint;
 423                   cached_is_l2 = is_l20 = subint0->flags & SUBINT_CONFIG_L2;
 424                 }
 425
 426               vnet_buffer (b0)->l2_hdr_offset = b0->current_data;
 427               vnet_buffer (b1)->l2_hdr_offset = b1->current_data;
 428
 429               if (PREDICT_TRUE (is_l20 != 0))
 430                 {
 431                   next0 = em->l2_next;
 432                   vnet_buffer (b0)->l2.l2_len = sizeof (ethernet_header_t);
 433                   next1 = em->l2_next;
 434                   vnet_buffer (b1)->l2.l2_len = sizeof (ethernet_header_t);
 435                 }
 436               else
 437                 {
 438                   if (!ethernet_address_cast (e0->dst_address) &&
 439                       (hi->hw_address != 0) &&
 440                       !eth_mac_equal ((u8 *) e0, hi->hw_address))
 441                     error0 = ETHERNET_ERROR_L3_MAC_MISMATCH;
 442                   if (!ethernet_address_cast (e1->dst_address) &&
 443                       (hi->hw_address != 0) &&
 444                       !eth_mac_equal ((u8 *) e1, hi->hw_address))
 445                     error1 = ETHERNET_ERROR_L3_MAC_MISMATCH;
 446                   determine_next_node (em, variant, 0, type0, b0,
 447                                        &error0, &next0);
 448                   vlib_buffer_advance (b0, sizeof (ethernet_header_t));
 449                   determine_next_node (em, variant, 0, type1, b1,
 450                                        &error1, &next1);
 451                   vlib_buffer_advance (b1, sizeof (ethernet_header_t));
 452                 }
 453               goto ship_it01;
 454             }
 455
 456           /* Slow-path for the tagged case */
 457         slowpath:
 458           parse_header (variant,
 459                         b0,
 460                         &type0,
 461                         &orig_type0, &outer_id0, &inner_id0, &match_flags0);
 462
 463           parse_header (variant,
 464                         b1,
 465                         &type1,
 466                         &orig_type1, &outer_id1, &inner_id1, &match_flags1);
 467
 468           old_sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
 469           old_sw_if_index1 = vnet_buffer (b1)->sw_if_index[VLIB_RX];
 470
 471           eth_vlan_table_lookups (em,
 472                                   vnm,
 473                                   old_sw_if_index0,
 474                                   orig_type0,
 475                                   outer_id0,
 476                                   inner_id0,
 477                                   &hi0,
 478                                   &main_intf0, &vlan_intf0, &qinq_intf0);
 479
 480           eth_vlan_table_lookups (em,
 481                                   vnm,
 482                                   old_sw_if_index1,
 483                                   orig_type1,
 484                                   outer_id1,
 485                                   inner_id1,
 486                                   &hi1,
 487                                   &main_intf1, &vlan_intf1, &qinq_intf1);
 488
 489           identify_subint (hi0,
 490                            b0,
 491                            match_flags0,
 492                            main_intf0,
 493                            vlan_intf0,
 494                            qinq_intf0, &new_sw_if_index0, &error0, &is_l20);
 495
 496           identify_subint (hi1,
 497                            b1,
 498                            match_flags1,
 499                            main_intf1,
 500                            vlan_intf1,
 501                            qinq_intf1, &new_sw_if_index1, &error1, &is_l21);
 502
 503           // Save RX sw_if_index for later nodes
 504           vnet_buffer (b0)->sw_if_index[VLIB_RX] =
 505             error0 !=
 506             ETHERNET_ERROR_NONE ? old_sw_if_index0 : new_sw_if_index0;
 507           vnet_buffer (b1)->sw_if_index[VLIB_RX] =
 508             error1 !=
 509             ETHERNET_ERROR_NONE ? old_sw_if_index1 : new_sw_if_index1;
 510
 511           // Check if there is a stat to take (valid and non-main sw_if_index for pkt 0 or pkt 1)
 512           if (((new_sw_if_index0 != ~0)
 513                && (new_sw_if_index0 != old_sw_if_index0))
 514               || ((new_sw_if_index1 != ~0)
 515                   && (new_sw_if_index1 != old_sw_if_index1)))
 516             {
 517
 518               len0 = vlib_buffer_length_in_chain (vm, b0) + b0->current_data
 519                 - vnet_buffer (b0)->l2_hdr_offset;
 520               len1 = vlib_buffer_length_in_chain (vm, b1) + b1->current_data
 521                 - vnet_buffer (b1)->l2_hdr_offset;
 522
 523               stats_n_packets += 2;
 524               stats_n_bytes += len0 + len1;
 525
 526               if (PREDICT_FALSE
 527                   (!(new_sw_if_index0 == stats_sw_if_index
 528                      && new_sw_if_index1 == stats_sw_if_index)))
 529                 {
 530                   stats_n_packets -= 2;
 531                   stats_n_bytes -= len0 + len1;
 532
 533                   if (new_sw_if_index0 != old_sw_if_index0
 534                       && new_sw_if_index0 != ~0)
 535                     vlib_increment_combined_counter (vnm->
 536                                                      interface_main.combined_sw_if_counters
 537                                                      +
 538                                                      VNET_INTERFACE_COUNTER_RX,
 539                                                      thread_index,
 540                                                      new_sw_if_index0, 1,
 541                                                      len0);
 542                   if (new_sw_if_index1 != old_sw_if_index1
 543                       && new_sw_if_index1 != ~0)
 544                     vlib_increment_combined_counter (vnm->
 545                                                      interface_main.combined_sw_if_counters
 546                                                      +
 547                                                      VNET_INTERFACE_COUNTER_RX,
 548                                                      thread_index,
 549                                                      new_sw_if_index1, 1,
 550                                                      len1);
 551
 552                   if (new_sw_if_index0 == new_sw_if_index1)
 553                     {
 554                       if (stats_n_packets > 0)
 555                         {
 556                           vlib_increment_combined_counter
 557                             (vnm->interface_main.combined_sw_if_counters
 558                              + VNET_INTERFACE_COUNTER_RX,
 559                              thread_index,
 560                              stats_sw_if_index,
 561                              stats_n_packets, stats_n_bytes);
 562                           stats_n_packets = stats_n_bytes = 0;
 563                         }
 564                       stats_sw_if_index = new_sw_if_index0;
 565                     }
 566                 }
 567             }
 568
 569           if (variant == ETHERNET_INPUT_VARIANT_NOT_L2)
 570             is_l20 = is_l21 = 0;
 571
 572           determine_next_node (em, variant, is_l20, type0, b0, &error0,
 573                                &next0);
 574           determine_next_node (em, variant, is_l21, type1, b1, &error1,
 575                                &next1);
 576
 577         ship_it01:
 578           b0->error = error_node->errors[error0];
 579           b1->error = error_node->errors[error1];
 580
 581           // verify speculative enqueue
 582           vlib_validate_buffer_enqueue_x2 (vm, node, next_index, to_next,
 583                                            n_left_to_next, bi0, bi1, next0,
 584                                            next1);
 585         }
 586
 587       while (n_left_from > 0 && n_left_to_next > 0)
 588         {
 589           u32 bi0;
 590           vlib_buffer_t *b0;
 591           u8 error0, next0;
 592           u16 type0, orig_type0;
 593           u16 outer_id0, inner_id0;
 594           u32 match_flags0;
 595           u32 old_sw_if_index0, new_sw_if_index0, len0;
 596           vnet_hw_interface_t *hi0;
 597           main_intf_t *main_intf0;
 598           vlan_intf_t *vlan_intf0;
 599           qinq_intf_t *qinq_intf0;
 600           ethernet_header_t *e0;
 601           u32 is_l20;
 602
 603           // Prefetch next iteration
 604           if (n_left_from > 1)
 605             {
 606               vlib_buffer_t *p2;
 607
 608               p2 = vlib_get_buffer (vm, from[1]);
 609               vlib_prefetch_buffer_header (p2, STORE);
 610               CLIB_PREFETCH (p2->data, CLIB_CACHE_LINE_BYTES, LOAD);
 611             }
 612
 613           bi0 = from[0];
 614           to_next[0] = bi0;
 615           from += 1;
 616           to_next += 1;
 617           n_left_from -= 1;
 618           n_left_to_next -= 1;
 619
 620           b0 = vlib_get_buffer (vm, bi0);
 621
 622           error0 = ETHERNET_ERROR_NONE;
 623           e0 = vlib_buffer_get_current (b0);
 624           type0 = clib_net_to_host_u16 (e0->type);
 625
 626           /* Speed-path for the untagged case */
 627           if (PREDICT_TRUE (variant == ETHERNET_INPUT_VARIANT_ETHERNET
 628                             && !ethernet_frame_is_tagged (type0)))
 629             {
 630               main_intf_t *intf0;
 631               subint_config_t *subint0;
 632               u32 sw_if_index0;
 633
 634               sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
 635               is_l20 = cached_is_l2;
 636
 637               if (PREDICT_FALSE (cached_sw_if_index != sw_if_index0))
 638                 {
 639                   cached_sw_if_index = sw_if_index0;
 640                   hi = vnet_get_sup_hw_interface (vnm, sw_if_index0);
 641                   intf0 = vec_elt_at_index (em->main_intfs, hi->hw_if_index);
 642                   subint0 = &intf0->untagged_subint;
 643                   cached_is_l2 = is_l20 = subint0->flags & SUBINT_CONFIG_L2;
 644                 }
 645
 646               vnet_buffer (b0)->l2_hdr_offset = b0->current_data;
 647
 648               if (PREDICT_TRUE (is_l20 != 0))
 649                 {
 650                   next0 = em->l2_next;
 651                   vnet_buffer (b0)->l2.l2_len = sizeof (ethernet_header_t);
 652                 }
 653               else
 654                 {
 655                   if (!ethernet_address_cast (e0->dst_address) &&
 656                       (hi->hw_address != 0) &&
 657                       !eth_mac_equal ((u8 *) e0, hi->hw_address))
 658                     error0 = ETHERNET_ERROR_L3_MAC_MISMATCH;
 659                   determine_next_node (em, variant, 0, type0, b0,
 660                                        &error0, &next0);
 661                   vlib_buffer_advance (b0, sizeof (ethernet_header_t));
 662                 }
 663               goto ship_it0;
 664             }
 665
 666           /* Slow-path for the tagged case */
 667           parse_header (variant,
 668                         b0,
 669                         &type0,
 670                         &orig_type0, &outer_id0, &inner_id0, &match_flags0);
 671
 672           old_sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
 673
 674           eth_vlan_table_lookups (em,
 675                                   vnm,
 676                                   old_sw_if_index0,
 677                                   orig_type0,
 678                                   outer_id0,
 679                                   inner_id0,
 680                                   &hi0,
 681                                   &main_intf0, &vlan_intf0, &qinq_intf0);
 682
 683           identify_subint (hi0,
 684                            b0,
 685                            match_flags0,
 686                            main_intf0,
 687                            vlan_intf0,
 688                            qinq_intf0, &new_sw_if_index0, &error0, &is_l20);
 689
 690           // Save RX sw_if_index for later nodes
 691           vnet_buffer (b0)->sw_if_index[VLIB_RX] =
 692             error0 !=
 693             ETHERNET_ERROR_NONE ? old_sw_if_index0 : new_sw_if_index0;
 694
 695           // Increment subinterface stats
 696           // Note that interface-level counters have already been incremented
 697           // prior to calling this function. Thus only subinterface counters
 698           // are incremented here.
 699           //
 700           // Interface level counters include packets received on the main
 701           // interface and all subinterfaces. Subinterface level counters
 702           // include only those packets received on that subinterface
 703           // Increment stats if the subint is valid and it is not the main intf
 704           if ((new_sw_if_index0 != ~0)
 705               && (new_sw_if_index0 != old_sw_if_index0))
 706             {
 707
 708               len0 = vlib_buffer_length_in_chain (vm, b0) + b0->current_data
 709                 - vnet_buffer (b0)->l2_hdr_offset;
 710
 711               stats_n_packets += 1;
 712               stats_n_bytes += len0;
 713
 714               // Batch stat increments from the same subinterface so counters
 715               // don't need to be incremented for every packet.
 716               if (PREDICT_FALSE (new_sw_if_index0 != stats_sw_if_index))
 717                 {
 718                   stats_n_packets -= 1;
 719                   stats_n_bytes -= len0;
 720
 721                   if (new_sw_if_index0 != ~0)
 722                     vlib_increment_combined_counter
 723                       (vnm->interface_main.combined_sw_if_counters
 724                        + VNET_INTERFACE_COUNTER_RX,
 725                        thread_index, new_sw_if_index0, 1, len0);
 726                   if (stats_n_packets > 0)
 727                     {
 728                       vlib_increment_combined_counter
 729                         (vnm->interface_main.combined_sw_if_counters
 730                          + VNET_INTERFACE_COUNTER_RX,
 731                          thread_index,
 732                          stats_sw_if_index, stats_n_packets, stats_n_bytes);
 733                       stats_n_packets = stats_n_bytes = 0;
 734                     }
 735                   stats_sw_if_index = new_sw_if_index0;
 736                 }
 737             }
 738
 739           if (variant == ETHERNET_INPUT_VARIANT_NOT_L2)
 740             is_l20 = 0;
 741
 742           determine_next_node (em, variant, is_l20, type0, b0, &error0,
 743                                &next0);
 744
 745         ship_it0:
 746           b0->error = error_node->errors[error0];
 747
 748           // verify speculative enqueue
 749           vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
 750                                            to_next, n_left_to_next,
 751                                            bi0, next0);
 752         }
 753
 754       vlib_put_next_frame (vm, node, next_index, n_left_to_next);
 755     }
 756
 757   // Increment any remaining batched stats
 758   if (stats_n_packets > 0)
 759     {
 760       vlib_increment_combined_counter
 761         (vnm->interface_main.combined_sw_if_counters
 762          + VNET_INTERFACE_COUNTER_RX,
 763          thread_index, stats_sw_if_index, stats_n_packets, stats_n_bytes);
 764       node->runtime_data[0] = stats_sw_if_index;
 765     }
 766
 767   return from_frame->n_vectors;
 768 }
 769
 770 static uword
 771 ethernet_input (vlib_main_t * vm,
 772                 vlib_node_runtime_t * node, vlib_frame_t * from_frame)
 773 {
 774   return ethernet_input_inline (vm, node, from_frame,
 775                                 ETHERNET_INPUT_VARIANT_ETHERNET);
 776 }
 777
 778 static uword
 779 ethernet_input_type (vlib_main_t * vm,
 780                      vlib_node_runtime_t * node, vlib_frame_t * from_frame)
 781 {
 782   return ethernet_input_inline (vm, node, from_frame,
 783                                 ETHERNET_INPUT_VARIANT_ETHERNET_TYPE);
 784 }
 785
 786 static uword
 787 ethernet_input_not_l2 (vlib_main_t * vm,
 788                        vlib_node_runtime_t * node, vlib_frame_t * from_frame)
 789 {
 790   return ethernet_input_inline (vm, node, from_frame,
 791                                 ETHERNET_INPUT_VARIANT_NOT_L2);
 792 }
 793
 794
 795 // Return the subinterface config struct for the given sw_if_index
 796 // Also return via parameter the appropriate match flags for the
 797 // configured number of tags.
 798 // On error (unsupported or not ethernet) return 0.
 799 static subint_config_t *
 800 ethernet_sw_interface_get_config (vnet_main_t * vnm,
 801                                   u32 sw_if_index,
 802                                   u32 * flags, u32 * unsupported)
 803 {
 804   ethernet_main_t *em = &ethernet_main;
 805   vnet_hw_interface_t *hi;
 806   vnet_sw_interface_t *si;
 807   main_intf_t *main_intf;
 808   vlan_table_t *vlan_table;
 809   qinq_table_t *qinq_table;
 810   subint_config_t *subint = 0;
 811
 812   hi = vnet_get_sup_hw_interface (vnm, sw_if_index);
 813
 814   if (!hi || (hi->hw_class_index != ethernet_hw_interface_class.index))
 815     {
 816       *unsupported = 0;
 817       goto done;                // non-ethernet interface
 818     }
 819
 820   // ensure there's an entry for the main intf (shouldn't really be necessary)
 821   vec_validate (em->main_intfs, hi->hw_if_index);
 822   main_intf = vec_elt_at_index (em->main_intfs, hi->hw_if_index);
 823
 824   // Locate the subint for the given ethernet config
 825   si = vnet_get_sw_interface (vnm, sw_if_index);
 826
 827   if (si->type == VNET_SW_INTERFACE_TYPE_P2P)
 828     {
 829       p2p_ethernet_main_t *p2pm = &p2p_main;
 830       u32 p2pe_sw_if_index =
 831         p2p_ethernet_lookup (hi->hw_if_index, si->p2p.client_mac);
 832       if (p2pe_sw_if_index == ~0)
 833         {
 834           pool_get (p2pm->p2p_subif_pool, subint);
 835           si->p2p.pool_index = subint - p2pm->p2p_subif_pool;
 836         }
 837       else
 838         subint = vec_elt_at_index (p2pm->p2p_subif_pool, si->p2p.pool_index);
 839       *flags = SUBINT_CONFIG_P2P;
 840     }
 841   else if (si->sub.eth.flags.default_sub)
 842     {
 843       subint = &main_intf->default_subint;
 844       *flags = SUBINT_CONFIG_MATCH_0_TAG |
 845         SUBINT_CONFIG_MATCH_1_TAG |
 846         SUBINT_CONFIG_MATCH_2_TAG | SUBINT_CONFIG_MATCH_3_TAG;
 847     }
 848   else if ((si->sub.eth.flags.no_tags) || (si->sub.eth.raw_flags == 0))
 849     {
 850       // if no flags are set then this is a main interface
 851       // so treat as untagged
 852       subint = &main_intf->untagged_subint;
 853       *flags = SUBINT_CONFIG_MATCH_0_TAG;
 854     }
 855   else
 856     {
 857       // one or two tags
 858       // first get the vlan table
 859       if (si->sub.eth.flags.dot1ad)
 860         {
 861           if (main_intf->dot1ad_vlans == 0)
 862             {
 863               // Allocate a vlan table from the pool
 864               pool_get (em->vlan_pool, vlan_table);
 865               main_intf->dot1ad_vlans = vlan_table - em->vlan_pool;
 866             }
 867           else
 868             {
 869               // Get ptr to existing vlan table
 870               vlan_table =
 871                 vec_elt_at_index (em->vlan_pool, main_intf->dot1ad_vlans);
 872             }
 873         }
 874       else
 875         {                       // dot1q
 876           if (main_intf->dot1q_vlans == 0)
 877             {
 878               // Allocate a vlan table from the pool
 879               pool_get (em->vlan_pool, vlan_table);
 880               main_intf->dot1q_vlans = vlan_table - em->vlan_pool;
 881             }
 882           else
 883             {
 884               // Get ptr to existing vlan table
 885               vlan_table =
 886                 vec_elt_at_index (em->vlan_pool, main_intf->dot1q_vlans);
 887             }
 888         }
 889
 890       if (si->sub.eth.flags.one_tag)
 891         {
 892           *flags = si->sub.eth.flags.exact_match ?
 893             SUBINT_CONFIG_MATCH_1_TAG :
 894             (SUBINT_CONFIG_MATCH_1_TAG |
 895              SUBINT_CONFIG_MATCH_2_TAG | SUBINT_CONFIG_MATCH_3_TAG);
 896
 897           if (si->sub.eth.flags.outer_vlan_id_any)
 898             {
 899               // not implemented yet
 900               *unsupported = 1;
 901               goto done;
 902             }
 903           else
 904             {
 905               // a single vlan, a common case
 906               subint =
 907                 &vlan_table->vlans[si->sub.eth.
 908                                    outer_vlan_id].single_tag_subint;
 909             }
 910
 911         }
 912       else
 913         {
 914           // Two tags
 915           *flags = si->sub.eth.flags.exact_match ?
 916             SUBINT_CONFIG_MATCH_2_TAG :
 917             (SUBINT_CONFIG_MATCH_2_TAG | SUBINT_CONFIG_MATCH_3_TAG);
 918
 919           if (si->sub.eth.flags.outer_vlan_id_any
 920               && si->sub.eth.flags.inner_vlan_id_any)
 921             {
 922               // not implemented yet
 923               *unsupported = 1;
 924               goto done;
 925             }
 926
 927           if (si->sub.eth.flags.inner_vlan_id_any)
 928             {
 929               // a specific outer and "any" inner
 930               // don't need a qinq table for this
 931               subint =
 932                 &vlan_table->vlans[si->sub.eth.
 933                                    outer_vlan_id].inner_any_subint;
 934               if (si->sub.eth.flags.exact_match)
 935                 {
 936                   *flags = SUBINT_CONFIG_MATCH_2_TAG;
 937                 }
 938               else
 939                 {
 940                   *flags = SUBINT_CONFIG_MATCH_2_TAG |
 941                     SUBINT_CONFIG_MATCH_3_TAG;
 942                 }
 943             }
 944           else
 945             {
 946               // a specific outer + specifc innner vlan id, a common case
 947
 948               // get the qinq table
 949               if (vlan_table->vlans[si->sub.eth.outer_vlan_id].qinqs == 0)
 950                 {
 951                   // Allocate a qinq table from the pool
 952                   pool_get (em->qinq_pool, qinq_table);
 953                   vlan_table->vlans[si->sub.eth.outer_vlan_id].qinqs =
 954                     qinq_table - em->qinq_pool;
 955                 }
 956               else
 957                 {
 958                   // Get ptr to existing qinq table
 959                   qinq_table =
 960                     vec_elt_at_index (em->qinq_pool,
 961                                       vlan_table->vlans[si->sub.
 962                                                         eth.outer_vlan_id].
 963                                       qinqs);
 964                 }
 965               subint = &qinq_table->vlans[si->sub.eth.inner_vlan_id].subint;
 966             }
 967         }
 968     }
 969
 970 done:
 971   return subint;
 972 }
 973
 974 clib_error_t *
 975 ethernet_sw_interface_up_down (vnet_main_t * vnm, u32 sw_if_index, u32 flags)
 976 {
 977   subint_config_t *subint;
 978   u32 dummy_flags;
 979   u32 dummy_unsup;
 980   clib_error_t *error = 0;
 981
 982   // Find the config for this subinterface
 983   subint =
 984     ethernet_sw_interface_get_config (vnm, sw_if_index, &dummy_flags,
 985                                       &dummy_unsup);
 986
 987   if (subint == 0)
 988     {
 989       // not implemented yet or not ethernet
 990       goto done;
 991     }
 992
 993   subint->sw_if_index =
 994     ((flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP) ? sw_if_index : ~0);
 995
 996 done:
 997   return error;
 998 }
 999
1000 VNET_SW_INTERFACE_ADMIN_UP_DOWN_FUNCTION (ethernet_sw_interface_up_down);
1001
1002
1003 // Set the L2/L3 mode for the subinterface
1004 void
1005 ethernet_sw_interface_set_l2_mode (vnet_main_t * vnm, u32 sw_if_index, u32 l2)
1006 {
1007   subint_config_t *subint;
1008   u32 dummy_flags;
1009   u32 dummy_unsup;
1010   int is_port;
1011   vnet_sw_interface_t *sw = vnet_get_sw_interface (vnm, sw_if_index);
1012
1013   is_port = !(sw->type == VNET_SW_INTERFACE_TYPE_SUB);
1014
1015   // Find the config for this subinterface
1016   subint =
1017     ethernet_sw_interface_get_config (vnm, sw_if_index, &dummy_flags,
1018                                       &dummy_unsup);
1019
1020   if (subint == 0)
1021     {
1022       // unimplemented or not ethernet
1023       goto done;
1024     }
1025
1026   // Double check that the config we found is for our interface (or the interface is down)
1027   ASSERT ((subint->sw_if_index == sw_if_index) | (subint->sw_if_index == ~0));
1028
1029   if (l2)
1030     {
1031       subint->flags |= SUBINT_CONFIG_L2;
1032       if (is_port)
1033         subint->flags |=
1034           SUBINT_CONFIG_MATCH_0_TAG | SUBINT_CONFIG_MATCH_1_TAG
1035           | SUBINT_CONFIG_MATCH_2_TAG | SUBINT_CONFIG_MATCH_3_TAG;
1036     }
1037   else
1038     {
1039       subint->flags &= ~SUBINT_CONFIG_L2;
1040       if (is_port)
1041         subint->flags &=
1042           ~(SUBINT_CONFIG_MATCH_1_TAG | SUBINT_CONFIG_MATCH_2_TAG
1043             | SUBINT_CONFIG_MATCH_3_TAG);
1044     }
1045
1046 done:
1047   return;
1048 }
1049
1050 /*
1051  * Set the L2/L3 mode for the subinterface regardless of port
1052  */
1053 void
1054 ethernet_sw_interface_set_l2_mode_noport (vnet_main_t * vnm,
1055                                           u32 sw_if_index, u32 l2)
1056 {
1057   subint_config_t *subint;
1058   u32 dummy_flags;
1059   u32 dummy_unsup;
1060
1061   /* Find the config for this subinterface */
1062   subint =
1063     ethernet_sw_interface_get_config (vnm, sw_if_index, &dummy_flags,
1064                                       &dummy_unsup);
1065
1066   if (subint == 0)
1067     {
1068       /* unimplemented or not ethernet */
1069       goto done;
1070     }
1071
1072   /*
1073    * Double check that the config we found is for our interface (or the
1074    * interface is down)
1075    */
1076   ASSERT ((subint->sw_if_index == sw_if_index) | (subint->sw_if_index == ~0));
1077
1078   if (l2)
1079     {
1080       subint->flags |= SUBINT_CONFIG_L2;
1081     }
1082   else
1083     {
1084       subint->flags &= ~SUBINT_CONFIG_L2;
1085     }
1086
1087 done:
1088   return;
1089 }
1090
1091 static clib_error_t *
1092 ethernet_sw_interface_add_del (vnet_main_t * vnm,
1093                                u32 sw_if_index, u32 is_create)
1094 {
1095   clib_error_t *error = 0;
1096   subint_config_t *subint;
1097   u32 match_flags;
1098   u32 unsupported = 0;
1099
1100   // Find the config for this subinterface
1101   subint =
1102     ethernet_sw_interface_get_config (vnm, sw_if_index, &match_flags,
1103                                       &unsupported);
1104
1105   if (subint == 0)
1106     {
1107       // not implemented yet or not ethernet
1108       if (unsupported)
1109         {
1110           // this is the NYI case
1111           error = clib_error_return (0, "not implemented yet");
1112         }
1113       goto done;
1114     }
1115
1116   if (!is_create)
1117     {
1118       subint->flags = 0;
1119       return error;
1120     }
1121
1122   // Initialize the subint
1123   if (subint->flags & SUBINT_CONFIG_VALID)
1124     {
1125       // Error vlan already in use
1126       error = clib_error_return (0, "vlan is already in use");
1127     }
1128   else
1129     {
1130       // Note that config is L3 by defaulty
1131       subint->flags = SUBINT_CONFIG_VALID | match_flags;
1132       subint->sw_if_index = ~0; // because interfaces are initially down
1133     }
1134
1135 done:
1136   return error;
1137 }
1138
1139 VNET_SW_INTERFACE_ADD_DEL_FUNCTION (ethernet_sw_interface_add_del);
1140
1141 static char *ethernet_error_strings[] = {
1142 #define ethernet_error(n,c,s) s,
1143 #include "error.def"
1144 #undef ethernet_error
1145 };
1146
1147 /* *INDENT-OFF* */
1148 VLIB_REGISTER_NODE (ethernet_input_node) = {
1149   .function = ethernet_input,
1150   .name = "ethernet-input",
1151   /* Takes a vector of packets. */
1152   .vector_size = sizeof (u32),
1153   .n_errors = ETHERNET_N_ERROR,
1154   .error_strings = ethernet_error_strings,
1155   .n_next_nodes = ETHERNET_INPUT_N_NEXT,
1156   .next_nodes = {
1157 #define _(s,n) [ETHERNET_INPUT_NEXT_##s] = n,
1158     foreach_ethernet_input_next
1159 #undef _
1160   },
1161   .format_buffer = format_ethernet_header_with_length,
1162   .format_trace = format_ethernet_input_trace,
1163   .unformat_buffer = unformat_ethernet_header,
1164 };
1165 /* *INDENT-ON* */
1166
1167 /* *INDENT-OFF* */
1168 VLIB_NODE_FUNCTION_MULTIARCH (ethernet_input_node, ethernet_input)
1169 /* *INDENT-ON* */
1170
1171 /* *INDENT-OFF* */
1172 VLIB_REGISTER_NODE (ethernet_input_type_node, static) = {
1173   .function = ethernet_input_type,
1174   .name = "ethernet-input-type",
1175   /* Takes a vector of packets. */
1176   .vector_size = sizeof (u32),
1177   .n_next_nodes = ETHERNET_INPUT_N_NEXT,
1178   .next_nodes = {
1179 #define _(s,n) [ETHERNET_INPUT_NEXT_##s] = n,
1180     foreach_ethernet_input_next
1181 #undef _
1182   },
1183 };
1184 /* *INDENT-ON* */
1185
1186 /* *INDENT-OFF* */
1187 VLIB_NODE_FUNCTION_MULTIARCH (ethernet_input_type_node, ethernet_input_type)
1188 /* *INDENT-ON* */
1189
1190 /* *INDENT-OFF* */
1191 VLIB_REGISTER_NODE (ethernet_input_not_l2_node, static) = {
1192   .function = ethernet_input_not_l2,
1193   .name = "ethernet-input-not-l2",
1194   /* Takes a vector of packets. */
1195   .vector_size = sizeof (u32),
1196   .n_next_nodes = ETHERNET_INPUT_N_NEXT,
1197   .next_nodes = {
1198 #define _(s,n) [ETHERNET_INPUT_NEXT_##s] = n,
1199     foreach_ethernet_input_next
1200 #undef _
1201   },
1202 };
1203 /* *INDENT-ON* */
1204
1205
1206 /* *INDENT-OFF* */
1207 VLIB_NODE_FUNCTION_MULTIARCH (ethernet_input_not_l2_node,
1208                               ethernet_input_not_l2)
1209 /* *INDENT-ON* */
1210
1211
1212 void
1213 ethernet_set_rx_redirect (vnet_main_t * vnm,
1214                           vnet_hw_interface_t * hi, u32 enable)
1215 {
1216   // Insure all packets go to ethernet-input (i.e. untagged ipv4 packets
1217   // don't go directly to ip4-input)
1218   vnet_hw_interface_rx_redirect_to_node
1219     (vnm, hi->hw_if_index, enable ? ethernet_input_node.index : ~0);
1220 }
1221
1222
1223 /*
1224  * Initialization and registration for the next_by_ethernet structure
1225  */
1226
1227 clib_error_t *
1228 next_by_ethertype_init (next_by_ethertype_t * l3_next)
1229 {
1230   l3_next->input_next_by_type = sparse_vec_new
1231     ( /* elt bytes */ sizeof (l3_next->input_next_by_type[0]),
1232      /* bits in index */ BITS (((ethernet_header_t *) 0)->type));
1233
1234   vec_validate (l3_next->sparse_index_by_input_next_index,
1235                 ETHERNET_INPUT_NEXT_DROP);
1236   vec_validate (l3_next->sparse_index_by_input_next_index,
1237                 ETHERNET_INPUT_NEXT_PUNT);
1238   l3_next->sparse_index_by_input_next_index[ETHERNET_INPUT_NEXT_DROP] =
1239     SPARSE_VEC_INVALID_INDEX;
1240   l3_next->sparse_index_by_input_next_index[ETHERNET_INPUT_NEXT_PUNT] =
1241     SPARSE_VEC_INVALID_INDEX;
1242
1243   /*
1244    * Make sure we don't wipe out an ethernet registration by mistake
1245    * Can happen if init function ordering constraints are missing.
1246    */
1247   if (CLIB_DEBUG > 0)
1248     {
1249       ethernet_main_t *em = &ethernet_main;
1250       ASSERT (em->next_by_ethertype_register_called == 0);
1251     }
1252
1253   return 0;
1254 }
1255
1256 // Add an ethertype -> next index mapping to the structure
1257 clib_error_t *
1258 next_by_ethertype_register (next_by_ethertype_t * l3_next,
1259                             u32 ethertype, u32 next_index)
1260 {
1261   u32 i;
1262   u16 *n;
1263   ethernet_main_t *em = &ethernet_main;
1264
1265   if (CLIB_DEBUG > 0)
1266     {
1267       ethernet_main_t *em = &ethernet_main;
1268       em->next_by_ethertype_register_called = 1;
1269     }
1270
1271   /* Setup ethernet type -> next index sparse vector mapping. */
1272   n = sparse_vec_validate (l3_next->input_next_by_type, ethertype);
1273   n[0] = next_index;
1274
1275   /* Rebuild next index -> sparse index inverse mapping when sparse vector
1276      is updated. */
1277   vec_validate (l3_next->sparse_index_by_input_next_index, next_index);
1278   for (i = 1; i < vec_len (l3_next->input_next_by_type); i++)
1279     l3_next->
1280       sparse_index_by_input_next_index[l3_next->input_next_by_type[i]] = i;
1281
1282   // do not allow the cached next index's to be updated if L3
1283   // redirect is enabled, as it will have overwritten them
1284   if (!em->redirect_l3)
1285     {
1286       // Cache common ethertypes directly
1287       if (ethertype == ETHERNET_TYPE_IP4)
1288         {
1289           l3_next->input_next_ip4 = next_index;
1290         }
1291       else if (ethertype == ETHERNET_TYPE_IP6)
1292         {
1293           l3_next->input_next_ip6 = next_index;
1294         }
1295       else if (ethertype == ETHERNET_TYPE_MPLS)
1296         {
1297           l3_next->input_next_mpls = next_index;
1298         }
1299     }
1300   return 0;
1301 }
1302
1303
1304 static clib_error_t *
1305 ethernet_input_init (vlib_main_t * vm)
1306 {
1307   ethernet_main_t *em = &ethernet_main;
1308   __attribute__ ((unused)) vlan_table_t *invalid_vlan_table;
1309   __attribute__ ((unused)) qinq_table_t *invalid_qinq_table;
1310
1311   ethernet_setup_node (vm, ethernet_input_node.index);
1312   ethernet_setup_node (vm, ethernet_input_type_node.index);
1313   ethernet_setup_node (vm, ethernet_input_not_l2_node.index);
1314
1315   next_by_ethertype_init (&em->l3_next);
1316
1317   // Initialize pools and vector for vlan parsing
1318   vec_validate (em->main_intfs, 10);    // 10 main interfaces
1319   pool_alloc (em->vlan_pool, 10);
1320   pool_alloc (em->qinq_pool, 1);
1321
1322   // The first vlan pool will always be reserved for an invalid table
1323   pool_get (em->vlan_pool, invalid_vlan_table); // first id = 0
1324   // The first qinq pool will always be reserved for an invalid table
1325   pool_get (em->qinq_pool, invalid_qinq_table); // first id = 0
1326
1327   return 0;
1328 }
1329
1330 VLIB_INIT_FUNCTION (ethernet_input_init);
1331
1332 void
1333 ethernet_register_input_type (vlib_main_t * vm,
1334                               ethernet_type_t type, u32 node_index)
1335 {
1336   ethernet_main_t *em = &ethernet_main;
1337   ethernet_type_info_t *ti;
1338   u32 i;
1339
1340   {
1341     clib_error_t *error = vlib_call_init_function (vm, ethernet_init);
1342     if (error)
1343       clib_error_report (error);
1344   }
1345
1346   ti = ethernet_get_type_info (em, type);
1347   ti->node_index = node_index;
1348   ti->next_index = vlib_node_add_next (vm,
1349                                        ethernet_input_node.index, node_index);
1350   i = vlib_node_add_next (vm, ethernet_input_type_node.index, node_index);
1351   ASSERT (i == ti->next_index);
1352
1353   i = vlib_node_add_next (vm, ethernet_input_not_l2_node.index, node_index);
1354   ASSERT (i == ti->next_index);
1355
1356   // Add the L3 node for this ethertype to the next nodes structure
1357   next_by_ethertype_register (&em->l3_next, type, ti->next_index);
1358
1359   // Call the registration functions for other nodes that want a mapping
1360   l2bvi_register_input_type (vm, type, node_index);
1361 }
1362
1363 void
1364 ethernet_register_l2_input (vlib_main_t * vm, u32 node_index)
1365 {
1366   ethernet_main_t *em = &ethernet_main;
1367   u32 i;
1368
1369   em->l2_next =
1370     vlib_node_add_next (vm, ethernet_input_node.index, node_index);
1371
1372   /*
1373    * Even if we never use these arcs, we have to align the next indices...
1374    */
1375   i = vlib_node_add_next (vm, ethernet_input_type_node.index, node_index);
1376
1377   ASSERT (i == em->l2_next);
1378
1379   i = vlib_node_add_next (vm, ethernet_input_not_l2_node.index, node_index);
1380   ASSERT (i == em->l2_next);
1381 }
1382
1383 // Register a next node for L3 redirect, and enable L3 redirect
1384 void
1385 ethernet_register_l3_redirect (vlib_main_t * vm, u32 node_index)
1386 {
1387   ethernet_main_t *em = &ethernet_main;
1388   u32 i;
1389
1390   em->redirect_l3 = 1;
1391   em->redirect_l3_next = vlib_node_add_next (vm,
1392                                              ethernet_input_node.index,
1393                                              node_index);
1394   /*
1395    * Change the cached next nodes to the redirect node
1396    */
1397   em->l3_next.input_next_ip4 = em->redirect_l3_next;
1398   em->l3_next.input_next_ip6 = em->redirect_l3_next;
1399   em->l3_next.input_next_mpls = em->redirect_l3_next;
1400
1401   /*
1402    * Even if we never use these arcs, we have to align the next indices...
1403    */
1404   i = vlib_node_add_next (vm, ethernet_input_type_node.index, node_index);
1405
1406   ASSERT (i == em->redirect_l3_next);
1407
1408   i = vlib_node_add_next (vm, ethernet_input_not_l2_node.index, node_index);
1409
1410   ASSERT (i == em->redirect_l3_next);
1411 }
1412
1413 /*
1414  * fd.io coding-style-patch-verification: ON
1415  *
1416  * Local Variables:
1417  * eval: (c-set-style "gnu")
1418  * End:
1419  */