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