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