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:
7 * http://www.apache.org/licenses/LICENSE-2.0
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.
16 * ethernet_node.c: ethernet packet processing
18 * Copyright (c) 2008 Eliot Dresselhaus
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:
28 * The above copyright notice and this permission notice shall be
29 * included in all copies or substantial portions of the Software.
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.
40 #include <vlib/vlib.h>
41 #include <vnet/pg/pg.h>
42 #include <vnet/ethernet/ethernet.h>
43 #include <vnet/ethernet/p2p_ethernet.h>
44 #include <vppinfra/sparse_vec.h>
45 #include <vnet/l2/l2_bvi.h>
48 #define foreach_ethernet_input_next \
49 _ (PUNT, "error-punt") \
50 _ (DROP, "error-drop") \
55 #define _(s,n) ETHERNET_INPUT_NEXT_##s,
56 foreach_ethernet_input_next
58 ETHERNET_INPUT_N_NEXT,
59 } ethernet_input_next_t;
64 } ethernet_input_trace_t;
67 format_ethernet_input_trace (u8 * s, va_list * va)
69 CLIB_UNUSED (vlib_main_t * vm) = va_arg (*va, vlib_main_t *);
70 CLIB_UNUSED (vlib_node_t * node) = va_arg (*va, vlib_node_t *);
71 ethernet_input_trace_t *t = va_arg (*va, ethernet_input_trace_t *);
73 s = format (s, "%U", format_ethernet_header, t->packet_data);
78 vlib_node_registration_t ethernet_input_node;
82 ETHERNET_INPUT_VARIANT_ETHERNET,
83 ETHERNET_INPUT_VARIANT_ETHERNET_TYPE,
84 ETHERNET_INPUT_VARIANT_NOT_L2,
85 } ethernet_input_variant_t;
88 // Parse the ethernet header to extract vlan tags and innermost ethertype
89 static_always_inline void
90 parse_header (ethernet_input_variant_t variant,
94 u16 * outer_id, u16 * inner_id, u32 * match_flags)
98 if (variant == ETHERNET_INPUT_VARIANT_ETHERNET
99 || variant == ETHERNET_INPUT_VARIANT_NOT_L2)
101 ethernet_header_t *e0;
103 e0 = (void *) (b0->data + b0->current_data);
105 vnet_buffer (b0)->l2_hdr_offset = b0->current_data;
106 b0->flags |= VNET_BUFFER_F_L2_HDR_OFFSET_VALID;
108 vlib_buffer_advance (b0, sizeof (e0[0]));
110 *type = clib_net_to_host_u16 (e0->type);
112 else if (variant == ETHERNET_INPUT_VARIANT_ETHERNET_TYPE)
114 // here when prior node was LLC/SNAP processing
117 e0 = (void *) (b0->data + b0->current_data);
119 vlib_buffer_advance (b0, sizeof (e0[0]));
121 *type = clib_net_to_host_u16 (e0[0]);
124 // save for distinguishing between dot1q and dot1ad later
127 // default the tags to 0 (used if there is no corresponding tag)
131 *match_flags = SUBINT_CONFIG_VALID | SUBINT_CONFIG_MATCH_0_TAG;
134 // check for vlan encaps
135 if (ethernet_frame_is_tagged (*type))
137 ethernet_vlan_header_t *h0;
140 *match_flags = SUBINT_CONFIG_VALID | SUBINT_CONFIG_MATCH_1_TAG;
142 h0 = (void *) (b0->data + b0->current_data);
144 tag = clib_net_to_host_u16 (h0->priority_cfi_and_id);
146 *outer_id = tag & 0xfff;
148 *match_flags &= ~SUBINT_CONFIG_MATCH_1_TAG;
150 *type = clib_net_to_host_u16 (h0->type);
152 vlib_buffer_advance (b0, sizeof (h0[0]));
155 if (*type == ETHERNET_TYPE_VLAN)
157 // Double tagged packet
158 *match_flags = SUBINT_CONFIG_VALID | SUBINT_CONFIG_MATCH_2_TAG;
160 h0 = (void *) (b0->data + b0->current_data);
162 tag = clib_net_to_host_u16 (h0->priority_cfi_and_id);
164 *inner_id = tag & 0xfff;
166 *type = clib_net_to_host_u16 (h0->type);
168 vlib_buffer_advance (b0, sizeof (h0[0]));
170 if (*type == ETHERNET_TYPE_VLAN)
172 // More than double tagged packet
173 *match_flags = SUBINT_CONFIG_VALID | SUBINT_CONFIG_MATCH_3_TAG;
175 vlib_buffer_advance (b0, sizeof (h0[0]));
176 vlan_count = 3; // "unknown" number, aka, 3-or-more
180 ethernet_buffer_set_vlan_count (b0, vlan_count);
183 // Determine the subinterface for this packet, given the result of the
184 // vlan table lookups and vlan header parsing. Check the most specific
186 static_always_inline void
187 identify_subint (vnet_hw_interface_t * hi,
190 main_intf_t * main_intf,
191 vlan_intf_t * vlan_intf,
192 qinq_intf_t * qinq_intf,
193 u32 * new_sw_if_index, u8 * error0, u32 * is_l2)
197 matched = eth_identify_subint (hi, b0, match_flags,
198 main_intf, vlan_intf, qinq_intf,
199 new_sw_if_index, error0, is_l2);
204 // Perform L3 my-mac filter
205 // A unicast packet arriving on an L3 interface must have a dmac matching the interface mac.
206 // This is required for promiscuous mode, else we will forward packets we aren't supposed to.
209 ethernet_header_t *e0;
210 e0 = (void *) (b0->data + vnet_buffer (b0)->l2_hdr_offset);
212 if (!(ethernet_address_cast (e0->dst_address)))
214 if (!eth_mac_equal ((u8 *) e0, hi->hw_address))
216 *error0 = ETHERNET_ERROR_L3_MAC_MISMATCH;
221 // Check for down subinterface
222 *error0 = (*new_sw_if_index) != ~0 ? (*error0) : ETHERNET_ERROR_DOWN;
226 static_always_inline void
227 determine_next_node (ethernet_main_t * em,
228 ethernet_input_variant_t variant,
230 u32 type0, vlib_buffer_t * b0, u8 * error0, u8 * next0)
232 u32 eth_start = vnet_buffer (b0)->l2_hdr_offset;
233 vnet_buffer (b0)->l2.l2_len = b0->current_data - eth_start;
234 if (PREDICT_FALSE (*error0 != ETHERNET_ERROR_NONE))
236 // some error occurred
237 *next0 = ETHERNET_INPUT_NEXT_DROP;
241 *next0 = em->l2_next;
242 // record the L2 len and reset the buffer so the L2 header is preserved
243 ASSERT (vnet_buffer (b0)->l2.l2_len ==
244 ethernet_buffer_header_size (b0));
245 vlib_buffer_advance (b0, -ethernet_buffer_header_size (b0));
247 // check for common IP/MPLS ethertypes
249 else if (type0 == ETHERNET_TYPE_IP4)
251 *next0 = em->l3_next.input_next_ip4;
253 else if (type0 == ETHERNET_TYPE_IP6)
255 *next0 = em->l3_next.input_next_ip6;
257 else if (type0 == ETHERNET_TYPE_MPLS)
259 *next0 = em->l3_next.input_next_mpls;
262 else if (em->redirect_l3)
264 // L3 Redirect is on, the cached common next nodes will be
265 // pointing to the redirect node, catch the uncommon types here
266 *next0 = em->redirect_l3_next;
270 // uncommon ethertype, check table
272 i0 = sparse_vec_index (em->l3_next.input_next_by_type, type0);
273 *next0 = vec_elt (em->l3_next.input_next_by_type, i0);
276 SPARSE_VEC_INVALID_INDEX ? ETHERNET_ERROR_UNKNOWN_TYPE : *error0;
278 // The table is not populated with LLC values, so check that now.
279 // If variant is variant_ethernet then we came from LLC processing. Don't
280 // go back there; drop instead using by keeping the drop/bad table result.
281 if ((type0 < 0x600) && (variant == ETHERNET_INPUT_VARIANT_ETHERNET))
283 *next0 = ETHERNET_INPUT_NEXT_LLC;
288 static_always_inline int
289 ethernet_frame_is_any_tagged (u16 type0, u16 type1)
292 const __m128i ethertype_mask = _mm_set_epi16 ((u16) ETHERNET_TYPE_VLAN,
293 (u16) ETHERNET_TYPE_DOT1AD,
294 (u16) ETHERNET_TYPE_VLAN_9100,
295 (u16) ETHERNET_TYPE_VLAN_9200,
296 /* duplicate for type1 */
297 (u16) ETHERNET_TYPE_VLAN,
298 (u16) ETHERNET_TYPE_DOT1AD,
299 (u16) ETHERNET_TYPE_VLAN_9100,
301 ETHERNET_TYPE_VLAN_9200);
304 _mm_set_epi16 (type0, type0, type0, type0, type1, type1, type1, type1);
305 r = _mm_cmpeq_epi16 (ethertype_mask, r);
306 return !_mm_test_all_zeros (r, r);
308 return ethernet_frame_is_tagged (type0) || ethernet_frame_is_tagged (type1);
312 static_always_inline uword
313 ethernet_input_inline (vlib_main_t * vm,
314 vlib_node_runtime_t * node,
315 vlib_frame_t * from_frame,
316 ethernet_input_variant_t variant)
318 vnet_main_t *vnm = vnet_get_main ();
319 ethernet_main_t *em = ðernet_main;
320 vlib_node_runtime_t *error_node;
321 u32 n_left_from, next_index, *from, *to_next;
322 u32 stats_sw_if_index, stats_n_packets, stats_n_bytes;
323 u32 thread_index = vlib_get_thread_index ();
324 u32 cached_sw_if_index = ~0;
325 u32 cached_is_l2 = 0; /* shut up gcc */
326 vnet_hw_interface_t *hi = NULL; /* used for main interface only */
328 if (variant != ETHERNET_INPUT_VARIANT_ETHERNET)
329 error_node = vlib_node_get_runtime (vm, ethernet_input_node.index);
333 from = vlib_frame_vector_args (from_frame);
334 n_left_from = from_frame->n_vectors;
336 if (node->flags & VLIB_NODE_FLAG_TRACE)
337 vlib_trace_frame_buffers_only (vm, node,
341 sizeof (ethernet_input_trace_t));
343 next_index = node->cached_next_index;
344 stats_sw_if_index = node->runtime_data[0];
345 stats_n_packets = stats_n_bytes = 0;
347 while (n_left_from > 0)
351 vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
353 while (n_left_from >= 4 && n_left_to_next >= 2)
356 vlib_buffer_t *b0, *b1;
357 u8 next0, next1, error0, error1;
358 u16 type0, orig_type0, type1, orig_type1;
359 u16 outer_id0, inner_id0, outer_id1, inner_id1;
360 u32 match_flags0, match_flags1;
361 u32 old_sw_if_index0, new_sw_if_index0, len0, old_sw_if_index1,
362 new_sw_if_index1, len1;
363 vnet_hw_interface_t *hi0, *hi1;
364 main_intf_t *main_intf0, *main_intf1;
365 vlan_intf_t *vlan_intf0, *vlan_intf1;
366 qinq_intf_t *qinq_intf0, *qinq_intf1;
368 ethernet_header_t *e0, *e1;
370 /* Prefetch next iteration. */
372 vlib_buffer_t *b2, *b3;
374 b2 = vlib_get_buffer (vm, from[2]);
375 b3 = vlib_get_buffer (vm, from[3]);
377 vlib_prefetch_buffer_header (b2, STORE);
378 vlib_prefetch_buffer_header (b3, STORE);
380 CLIB_PREFETCH (b2->data, sizeof (ethernet_header_t), LOAD);
381 CLIB_PREFETCH (b3->data, sizeof (ethernet_header_t), LOAD);
393 b0 = vlib_get_buffer (vm, bi0);
394 b1 = vlib_get_buffer (vm, bi1);
396 error0 = error1 = ETHERNET_ERROR_NONE;
397 e0 = vlib_buffer_get_current (b0);
398 type0 = clib_net_to_host_u16 (e0->type);
399 e1 = vlib_buffer_get_current (b1);
400 type1 = clib_net_to_host_u16 (e1->type);
402 /* Speed-path for the untagged case */
403 if (PREDICT_TRUE (variant == ETHERNET_INPUT_VARIANT_ETHERNET
404 && !ethernet_frame_is_any_tagged (type0, type1)))
407 subint_config_t *subint0;
408 u32 sw_if_index0, sw_if_index1;
410 sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
411 sw_if_index1 = vnet_buffer (b1)->sw_if_index[VLIB_RX];
412 is_l20 = cached_is_l2;
414 /* This is probably wholly unnecessary */
415 if (PREDICT_FALSE (sw_if_index0 != sw_if_index1))
418 /* Now sw_if_index0 == sw_if_index1 */
419 if (PREDICT_FALSE (cached_sw_if_index != sw_if_index0))
421 cached_sw_if_index = sw_if_index0;
422 hi = vnet_get_sup_hw_interface (vnm, sw_if_index0);
423 intf0 = vec_elt_at_index (em->main_intfs, hi->hw_if_index);
424 subint0 = &intf0->untagged_subint;
425 cached_is_l2 = is_l20 = subint0->flags & SUBINT_CONFIG_L2;
428 vnet_buffer (b0)->l2_hdr_offset = b0->current_data;
429 vnet_buffer (b1)->l2_hdr_offset = b1->current_data;
430 vnet_buffer (b0)->l3_hdr_offset =
431 vnet_buffer (b0)->l2_hdr_offset + sizeof (ethernet_header_t);
432 vnet_buffer (b1)->l3_hdr_offset =
433 vnet_buffer (b1)->l2_hdr_offset + sizeof (ethernet_header_t);
434 b0->flags |= VNET_BUFFER_F_L2_HDR_OFFSET_VALID |
435 VNET_BUFFER_F_L3_HDR_OFFSET_VALID;
436 b1->flags |= VNET_BUFFER_F_L2_HDR_OFFSET_VALID |
437 VNET_BUFFER_F_L3_HDR_OFFSET_VALID;
439 if (PREDICT_TRUE (is_l20 != 0))
442 vnet_buffer (b0)->l2.l2_len = sizeof (ethernet_header_t);
444 vnet_buffer (b1)->l2.l2_len = sizeof (ethernet_header_t);
448 if (!ethernet_address_cast (e0->dst_address) &&
449 (hi->hw_address != 0) &&
450 !eth_mac_equal ((u8 *) e0, hi->hw_address))
451 error0 = ETHERNET_ERROR_L3_MAC_MISMATCH;
452 if (!ethernet_address_cast (e1->dst_address) &&
453 (hi->hw_address != 0) &&
454 !eth_mac_equal ((u8 *) e1, hi->hw_address))
455 error1 = ETHERNET_ERROR_L3_MAC_MISMATCH;
456 determine_next_node (em, variant, 0, type0, b0,
458 vlib_buffer_advance (b0, sizeof (ethernet_header_t));
459 determine_next_node (em, variant, 0, type1, b1,
461 vlib_buffer_advance (b1, sizeof (ethernet_header_t));
466 /* Slow-path for the tagged case */
468 parse_header (variant,
471 &orig_type0, &outer_id0, &inner_id0, &match_flags0);
473 parse_header (variant,
476 &orig_type1, &outer_id1, &inner_id1, &match_flags1);
478 old_sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
479 old_sw_if_index1 = vnet_buffer (b1)->sw_if_index[VLIB_RX];
481 eth_vlan_table_lookups (em,
488 &main_intf0, &vlan_intf0, &qinq_intf0);
490 eth_vlan_table_lookups (em,
497 &main_intf1, &vlan_intf1, &qinq_intf1);
499 identify_subint (hi0,
504 qinq_intf0, &new_sw_if_index0, &error0, &is_l20);
506 identify_subint (hi1,
511 qinq_intf1, &new_sw_if_index1, &error1, &is_l21);
513 // Save RX sw_if_index for later nodes
514 vnet_buffer (b0)->sw_if_index[VLIB_RX] =
516 ETHERNET_ERROR_NONE ? old_sw_if_index0 : new_sw_if_index0;
517 vnet_buffer (b1)->sw_if_index[VLIB_RX] =
519 ETHERNET_ERROR_NONE ? old_sw_if_index1 : new_sw_if_index1;
521 // Check if there is a stat to take (valid and non-main sw_if_index for pkt 0 or pkt 1)
522 if (((new_sw_if_index0 != ~0)
523 && (new_sw_if_index0 != old_sw_if_index0))
524 || ((new_sw_if_index1 != ~0)
525 && (new_sw_if_index1 != old_sw_if_index1)))
528 len0 = vlib_buffer_length_in_chain (vm, b0) + b0->current_data
529 - vnet_buffer (b0)->l2_hdr_offset;
530 len1 = vlib_buffer_length_in_chain (vm, b1) + b1->current_data
531 - vnet_buffer (b1)->l2_hdr_offset;
533 stats_n_packets += 2;
534 stats_n_bytes += len0 + len1;
537 (!(new_sw_if_index0 == stats_sw_if_index
538 && new_sw_if_index1 == stats_sw_if_index)))
540 stats_n_packets -= 2;
541 stats_n_bytes -= len0 + len1;
543 if (new_sw_if_index0 != old_sw_if_index0
544 && new_sw_if_index0 != ~0)
545 vlib_increment_combined_counter (vnm->
546 interface_main.combined_sw_if_counters
548 VNET_INTERFACE_COUNTER_RX,
552 if (new_sw_if_index1 != old_sw_if_index1
553 && new_sw_if_index1 != ~0)
554 vlib_increment_combined_counter (vnm->
555 interface_main.combined_sw_if_counters
557 VNET_INTERFACE_COUNTER_RX,
562 if (new_sw_if_index0 == new_sw_if_index1)
564 if (stats_n_packets > 0)
566 vlib_increment_combined_counter
567 (vnm->interface_main.combined_sw_if_counters
568 + VNET_INTERFACE_COUNTER_RX,
571 stats_n_packets, stats_n_bytes);
572 stats_n_packets = stats_n_bytes = 0;
574 stats_sw_if_index = new_sw_if_index0;
579 if (variant == ETHERNET_INPUT_VARIANT_NOT_L2)
582 determine_next_node (em, variant, is_l20, type0, b0, &error0,
584 determine_next_node (em, variant, is_l21, type1, b1, &error1,
586 vnet_buffer (b0)->l3_hdr_offset = vnet_buffer (b0)->l2_hdr_offset +
587 vnet_buffer (b0)->l2.l2_len;
588 vnet_buffer (b1)->l3_hdr_offset = vnet_buffer (b1)->l2_hdr_offset +
589 vnet_buffer (b1)->l2.l2_len;
590 b0->flags |= VNET_BUFFER_F_L3_HDR_OFFSET_VALID;
591 b1->flags |= VNET_BUFFER_F_L3_HDR_OFFSET_VALID;
594 b0->error = error_node->errors[error0];
595 b1->error = error_node->errors[error1];
597 // verify speculative enqueue
598 vlib_validate_buffer_enqueue_x2 (vm, node, next_index, to_next,
599 n_left_to_next, bi0, bi1, next0,
603 while (n_left_from > 0 && n_left_to_next > 0)
608 u16 type0, orig_type0;
609 u16 outer_id0, inner_id0;
611 u32 old_sw_if_index0, new_sw_if_index0, len0;
612 vnet_hw_interface_t *hi0;
613 main_intf_t *main_intf0;
614 vlan_intf_t *vlan_intf0;
615 qinq_intf_t *qinq_intf0;
616 ethernet_header_t *e0;
619 // Prefetch next iteration
624 p2 = vlib_get_buffer (vm, from[1]);
625 vlib_prefetch_buffer_header (p2, STORE);
626 CLIB_PREFETCH (p2->data, CLIB_CACHE_LINE_BYTES, LOAD);
636 b0 = vlib_get_buffer (vm, bi0);
638 error0 = ETHERNET_ERROR_NONE;
639 e0 = vlib_buffer_get_current (b0);
640 type0 = clib_net_to_host_u16 (e0->type);
642 /* Speed-path for the untagged case */
643 if (PREDICT_TRUE (variant == ETHERNET_INPUT_VARIANT_ETHERNET
644 && !ethernet_frame_is_tagged (type0)))
647 subint_config_t *subint0;
650 sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
651 is_l20 = cached_is_l2;
653 if (PREDICT_FALSE (cached_sw_if_index != sw_if_index0))
655 cached_sw_if_index = sw_if_index0;
656 hi = vnet_get_sup_hw_interface (vnm, sw_if_index0);
657 intf0 = vec_elt_at_index (em->main_intfs, hi->hw_if_index);
658 subint0 = &intf0->untagged_subint;
659 cached_is_l2 = is_l20 = subint0->flags & SUBINT_CONFIG_L2;
662 vnet_buffer (b0)->l2_hdr_offset = b0->current_data;
663 vnet_buffer (b0)->l3_hdr_offset =
664 vnet_buffer (b0)->l2_hdr_offset + sizeof (ethernet_header_t);
665 b0->flags |= VNET_BUFFER_F_L2_HDR_OFFSET_VALID |
666 VNET_BUFFER_F_L3_HDR_OFFSET_VALID;
668 if (PREDICT_TRUE (is_l20 != 0))
671 vnet_buffer (b0)->l2.l2_len = sizeof (ethernet_header_t);
675 if (!ethernet_address_cast (e0->dst_address) &&
676 (hi->hw_address != 0) &&
677 !eth_mac_equal ((u8 *) e0, hi->hw_address))
678 error0 = ETHERNET_ERROR_L3_MAC_MISMATCH;
679 determine_next_node (em, variant, 0, type0, b0,
681 vlib_buffer_advance (b0, sizeof (ethernet_header_t));
686 /* Slow-path for the tagged case */
687 parse_header (variant,
690 &orig_type0, &outer_id0, &inner_id0, &match_flags0);
692 old_sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
694 eth_vlan_table_lookups (em,
701 &main_intf0, &vlan_intf0, &qinq_intf0);
703 identify_subint (hi0,
708 qinq_intf0, &new_sw_if_index0, &error0, &is_l20);
710 // Save RX sw_if_index for later nodes
711 vnet_buffer (b0)->sw_if_index[VLIB_RX] =
713 ETHERNET_ERROR_NONE ? old_sw_if_index0 : new_sw_if_index0;
715 // Increment subinterface stats
716 // Note that interface-level counters have already been incremented
717 // prior to calling this function. Thus only subinterface counters
718 // are incremented here.
720 // Interface level counters include packets received on the main
721 // interface and all subinterfaces. Subinterface level counters
722 // include only those packets received on that subinterface
723 // Increment stats if the subint is valid and it is not the main intf
724 if ((new_sw_if_index0 != ~0)
725 && (new_sw_if_index0 != old_sw_if_index0))
728 len0 = vlib_buffer_length_in_chain (vm, b0) + b0->current_data
729 - vnet_buffer (b0)->l2_hdr_offset;
731 stats_n_packets += 1;
732 stats_n_bytes += len0;
734 // Batch stat increments from the same subinterface so counters
735 // don't need to be incremented for every packet.
736 if (PREDICT_FALSE (new_sw_if_index0 != stats_sw_if_index))
738 stats_n_packets -= 1;
739 stats_n_bytes -= len0;
741 if (new_sw_if_index0 != ~0)
742 vlib_increment_combined_counter
743 (vnm->interface_main.combined_sw_if_counters
744 + VNET_INTERFACE_COUNTER_RX,
745 thread_index, new_sw_if_index0, 1, len0);
746 if (stats_n_packets > 0)
748 vlib_increment_combined_counter
749 (vnm->interface_main.combined_sw_if_counters
750 + VNET_INTERFACE_COUNTER_RX,
752 stats_sw_if_index, stats_n_packets, stats_n_bytes);
753 stats_n_packets = stats_n_bytes = 0;
755 stats_sw_if_index = new_sw_if_index0;
759 if (variant == ETHERNET_INPUT_VARIANT_NOT_L2)
762 determine_next_node (em, variant, is_l20, type0, b0, &error0,
764 vnet_buffer (b0)->l3_hdr_offset = vnet_buffer (b0)->l2_hdr_offset +
765 vnet_buffer (b0)->l2.l2_len;
766 b0->flags |= VNET_BUFFER_F_L3_HDR_OFFSET_VALID;
769 b0->error = error_node->errors[error0];
771 // verify speculative enqueue
772 vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
773 to_next, n_left_to_next,
777 vlib_put_next_frame (vm, node, next_index, n_left_to_next);
780 // Increment any remaining batched stats
781 if (stats_n_packets > 0)
783 vlib_increment_combined_counter
784 (vnm->interface_main.combined_sw_if_counters
785 + VNET_INTERFACE_COUNTER_RX,
786 thread_index, stats_sw_if_index, stats_n_packets, stats_n_bytes);
787 node->runtime_data[0] = stats_sw_if_index;
790 return from_frame->n_vectors;
794 ethernet_input (vlib_main_t * vm,
795 vlib_node_runtime_t * node, vlib_frame_t * from_frame)
797 return ethernet_input_inline (vm, node, from_frame,
798 ETHERNET_INPUT_VARIANT_ETHERNET);
802 ethernet_input_type (vlib_main_t * vm,
803 vlib_node_runtime_t * node, vlib_frame_t * from_frame)
805 return ethernet_input_inline (vm, node, from_frame,
806 ETHERNET_INPUT_VARIANT_ETHERNET_TYPE);
810 ethernet_input_not_l2 (vlib_main_t * vm,
811 vlib_node_runtime_t * node, vlib_frame_t * from_frame)
813 return ethernet_input_inline (vm, node, from_frame,
814 ETHERNET_INPUT_VARIANT_NOT_L2);
818 // Return the subinterface config struct for the given sw_if_index
819 // Also return via parameter the appropriate match flags for the
820 // configured number of tags.
821 // On error (unsupported or not ethernet) return 0.
822 static subint_config_t *
823 ethernet_sw_interface_get_config (vnet_main_t * vnm,
825 u32 * flags, u32 * unsupported)
827 ethernet_main_t *em = ðernet_main;
828 vnet_hw_interface_t *hi;
829 vnet_sw_interface_t *si;
830 main_intf_t *main_intf;
831 vlan_table_t *vlan_table;
832 qinq_table_t *qinq_table;
833 subint_config_t *subint = 0;
835 hi = vnet_get_sup_hw_interface (vnm, sw_if_index);
837 if (!hi || (hi->hw_class_index != ethernet_hw_interface_class.index))
840 goto done; // non-ethernet interface
843 // ensure there's an entry for the main intf (shouldn't really be necessary)
844 vec_validate (em->main_intfs, hi->hw_if_index);
845 main_intf = vec_elt_at_index (em->main_intfs, hi->hw_if_index);
847 // Locate the subint for the given ethernet config
848 si = vnet_get_sw_interface (vnm, sw_if_index);
850 if (si->type == VNET_SW_INTERFACE_TYPE_P2P)
852 p2p_ethernet_main_t *p2pm = &p2p_main;
853 u32 p2pe_sw_if_index =
854 p2p_ethernet_lookup (hi->hw_if_index, si->p2p.client_mac);
855 if (p2pe_sw_if_index == ~0)
857 pool_get (p2pm->p2p_subif_pool, subint);
858 si->p2p.pool_index = subint - p2pm->p2p_subif_pool;
861 subint = vec_elt_at_index (p2pm->p2p_subif_pool, si->p2p.pool_index);
862 *flags = SUBINT_CONFIG_P2P;
864 else if (si->sub.eth.flags.default_sub)
866 subint = &main_intf->default_subint;
867 *flags = SUBINT_CONFIG_MATCH_0_TAG |
868 SUBINT_CONFIG_MATCH_1_TAG |
869 SUBINT_CONFIG_MATCH_2_TAG | SUBINT_CONFIG_MATCH_3_TAG;
871 else if ((si->sub.eth.flags.no_tags) || (si->sub.eth.raw_flags == 0))
873 // if no flags are set then this is a main interface
874 // so treat as untagged
875 subint = &main_intf->untagged_subint;
876 *flags = SUBINT_CONFIG_MATCH_0_TAG;
881 // first get the vlan table
882 if (si->sub.eth.flags.dot1ad)
884 if (main_intf->dot1ad_vlans == 0)
886 // Allocate a vlan table from the pool
887 pool_get (em->vlan_pool, vlan_table);
888 main_intf->dot1ad_vlans = vlan_table - em->vlan_pool;
892 // Get ptr to existing vlan table
894 vec_elt_at_index (em->vlan_pool, main_intf->dot1ad_vlans);
899 if (main_intf->dot1q_vlans == 0)
901 // Allocate a vlan table from the pool
902 pool_get (em->vlan_pool, vlan_table);
903 main_intf->dot1q_vlans = vlan_table - em->vlan_pool;
907 // Get ptr to existing vlan table
909 vec_elt_at_index (em->vlan_pool, main_intf->dot1q_vlans);
913 if (si->sub.eth.flags.one_tag)
915 *flags = si->sub.eth.flags.exact_match ?
916 SUBINT_CONFIG_MATCH_1_TAG :
917 (SUBINT_CONFIG_MATCH_1_TAG |
918 SUBINT_CONFIG_MATCH_2_TAG | SUBINT_CONFIG_MATCH_3_TAG);
920 if (si->sub.eth.flags.outer_vlan_id_any)
922 // not implemented yet
928 // a single vlan, a common case
930 &vlan_table->vlans[si->sub.eth.
931 outer_vlan_id].single_tag_subint;
938 *flags = si->sub.eth.flags.exact_match ?
939 SUBINT_CONFIG_MATCH_2_TAG :
940 (SUBINT_CONFIG_MATCH_2_TAG | SUBINT_CONFIG_MATCH_3_TAG);
942 if (si->sub.eth.flags.outer_vlan_id_any
943 && si->sub.eth.flags.inner_vlan_id_any)
945 // not implemented yet
950 if (si->sub.eth.flags.inner_vlan_id_any)
952 // a specific outer and "any" inner
953 // don't need a qinq table for this
955 &vlan_table->vlans[si->sub.eth.
956 outer_vlan_id].inner_any_subint;
957 if (si->sub.eth.flags.exact_match)
959 *flags = SUBINT_CONFIG_MATCH_2_TAG;
963 *flags = SUBINT_CONFIG_MATCH_2_TAG |
964 SUBINT_CONFIG_MATCH_3_TAG;
969 // a specific outer + specifc innner vlan id, a common case
971 // get the qinq table
972 if (vlan_table->vlans[si->sub.eth.outer_vlan_id].qinqs == 0)
974 // Allocate a qinq table from the pool
975 pool_get (em->qinq_pool, qinq_table);
976 vlan_table->vlans[si->sub.eth.outer_vlan_id].qinqs =
977 qinq_table - em->qinq_pool;
981 // Get ptr to existing qinq table
983 vec_elt_at_index (em->qinq_pool,
984 vlan_table->vlans[si->sub.
988 subint = &qinq_table->vlans[si->sub.eth.inner_vlan_id].subint;
998 ethernet_sw_interface_up_down (vnet_main_t * vnm, u32 sw_if_index, u32 flags)
1000 subint_config_t *subint;
1003 clib_error_t *error = 0;
1005 // Find the config for this subinterface
1007 ethernet_sw_interface_get_config (vnm, sw_if_index, &dummy_flags,
1012 // not implemented yet or not ethernet
1016 subint->sw_if_index =
1017 ((flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP) ? sw_if_index : ~0);
1023 VNET_SW_INTERFACE_ADMIN_UP_DOWN_FUNCTION (ethernet_sw_interface_up_down);
1026 // Set the L2/L3 mode for the subinterface
1028 ethernet_sw_interface_set_l2_mode (vnet_main_t * vnm, u32 sw_if_index, u32 l2)
1030 subint_config_t *subint;
1034 vnet_sw_interface_t *sw = vnet_get_sw_interface (vnm, sw_if_index);
1036 is_port = !(sw->type == VNET_SW_INTERFACE_TYPE_SUB);
1038 // Find the config for this subinterface
1040 ethernet_sw_interface_get_config (vnm, sw_if_index, &dummy_flags,
1045 // unimplemented or not ethernet
1049 // Double check that the config we found is for our interface (or the interface is down)
1050 ASSERT ((subint->sw_if_index == sw_if_index) | (subint->sw_if_index == ~0));
1054 subint->flags |= SUBINT_CONFIG_L2;
1057 SUBINT_CONFIG_MATCH_0_TAG | SUBINT_CONFIG_MATCH_1_TAG
1058 | SUBINT_CONFIG_MATCH_2_TAG | SUBINT_CONFIG_MATCH_3_TAG;
1062 subint->flags &= ~SUBINT_CONFIG_L2;
1065 ~(SUBINT_CONFIG_MATCH_1_TAG | SUBINT_CONFIG_MATCH_2_TAG
1066 | SUBINT_CONFIG_MATCH_3_TAG);
1074 * Set the L2/L3 mode for the subinterface regardless of port
1077 ethernet_sw_interface_set_l2_mode_noport (vnet_main_t * vnm,
1078 u32 sw_if_index, u32 l2)
1080 subint_config_t *subint;
1084 /* Find the config for this subinterface */
1086 ethernet_sw_interface_get_config (vnm, sw_if_index, &dummy_flags,
1091 /* unimplemented or not ethernet */
1096 * Double check that the config we found is for our interface (or the
1097 * interface is down)
1099 ASSERT ((subint->sw_if_index == sw_if_index) | (subint->sw_if_index == ~0));
1103 subint->flags |= SUBINT_CONFIG_L2;
1107 subint->flags &= ~SUBINT_CONFIG_L2;
1114 static clib_error_t *
1115 ethernet_sw_interface_add_del (vnet_main_t * vnm,
1116 u32 sw_if_index, u32 is_create)
1118 clib_error_t *error = 0;
1119 subint_config_t *subint;
1121 u32 unsupported = 0;
1123 // Find the config for this subinterface
1125 ethernet_sw_interface_get_config (vnm, sw_if_index, &match_flags,
1130 // not implemented yet or not ethernet
1133 // this is the NYI case
1134 error = clib_error_return (0, "not implemented yet");
1145 // Initialize the subint
1146 if (subint->flags & SUBINT_CONFIG_VALID)
1148 // Error vlan already in use
1149 error = clib_error_return (0, "vlan is already in use");
1153 // Note that config is L3 by defaulty
1154 subint->flags = SUBINT_CONFIG_VALID | match_flags;
1155 subint->sw_if_index = ~0; // because interfaces are initially down
1162 VNET_SW_INTERFACE_ADD_DEL_FUNCTION (ethernet_sw_interface_add_del);
1164 static char *ethernet_error_strings[] = {
1165 #define ethernet_error(n,c,s) s,
1166 #include "error.def"
1167 #undef ethernet_error
1171 VLIB_REGISTER_NODE (ethernet_input_node) = {
1172 .function = ethernet_input,
1173 .name = "ethernet-input",
1174 /* Takes a vector of packets. */
1175 .vector_size = sizeof (u32),
1176 .n_errors = ETHERNET_N_ERROR,
1177 .error_strings = ethernet_error_strings,
1178 .n_next_nodes = ETHERNET_INPUT_N_NEXT,
1180 #define _(s,n) [ETHERNET_INPUT_NEXT_##s] = n,
1181 foreach_ethernet_input_next
1184 .format_buffer = format_ethernet_header_with_length,
1185 .format_trace = format_ethernet_input_trace,
1186 .unformat_buffer = unformat_ethernet_header,
1191 VLIB_NODE_FUNCTION_MULTIARCH (ethernet_input_node, ethernet_input)
1195 VLIB_REGISTER_NODE (ethernet_input_type_node, static) = {
1196 .function = ethernet_input_type,
1197 .name = "ethernet-input-type",
1198 /* Takes a vector of packets. */
1199 .vector_size = sizeof (u32),
1200 .n_next_nodes = ETHERNET_INPUT_N_NEXT,
1202 #define _(s,n) [ETHERNET_INPUT_NEXT_##s] = n,
1203 foreach_ethernet_input_next
1210 VLIB_NODE_FUNCTION_MULTIARCH (ethernet_input_type_node, ethernet_input_type)
1214 VLIB_REGISTER_NODE (ethernet_input_not_l2_node, static) = {
1215 .function = ethernet_input_not_l2,
1216 .name = "ethernet-input-not-l2",
1217 /* Takes a vector of packets. */
1218 .vector_size = sizeof (u32),
1219 .n_next_nodes = ETHERNET_INPUT_N_NEXT,
1221 #define _(s,n) [ETHERNET_INPUT_NEXT_##s] = n,
1222 foreach_ethernet_input_next
1230 VLIB_NODE_FUNCTION_MULTIARCH (ethernet_input_not_l2_node,
1231 ethernet_input_not_l2)
1236 ethernet_set_rx_redirect (vnet_main_t * vnm,
1237 vnet_hw_interface_t * hi, u32 enable)
1239 // Insure all packets go to ethernet-input (i.e. untagged ipv4 packets
1240 // don't go directly to ip4-input)
1241 vnet_hw_interface_rx_redirect_to_node
1242 (vnm, hi->hw_if_index, enable ? ethernet_input_node.index : ~0);
1247 * Initialization and registration for the next_by_ethernet structure
1251 next_by_ethertype_init (next_by_ethertype_t * l3_next)
1253 l3_next->input_next_by_type = sparse_vec_new
1254 ( /* elt bytes */ sizeof (l3_next->input_next_by_type[0]),
1255 /* bits in index */ BITS (((ethernet_header_t *) 0)->type));
1257 vec_validate (l3_next->sparse_index_by_input_next_index,
1258 ETHERNET_INPUT_NEXT_DROP);
1259 vec_validate (l3_next->sparse_index_by_input_next_index,
1260 ETHERNET_INPUT_NEXT_PUNT);
1261 l3_next->sparse_index_by_input_next_index[ETHERNET_INPUT_NEXT_DROP] =
1262 SPARSE_VEC_INVALID_INDEX;
1263 l3_next->sparse_index_by_input_next_index[ETHERNET_INPUT_NEXT_PUNT] =
1264 SPARSE_VEC_INVALID_INDEX;
1267 * Make sure we don't wipe out an ethernet registration by mistake
1268 * Can happen if init function ordering constraints are missing.
1272 ethernet_main_t *em = ðernet_main;
1273 ASSERT (em->next_by_ethertype_register_called == 0);
1279 // Add an ethertype -> next index mapping to the structure
1281 next_by_ethertype_register (next_by_ethertype_t * l3_next,
1282 u32 ethertype, u32 next_index)
1286 ethernet_main_t *em = ðernet_main;
1290 ethernet_main_t *em = ðernet_main;
1291 em->next_by_ethertype_register_called = 1;
1294 /* Setup ethernet type -> next index sparse vector mapping. */
1295 n = sparse_vec_validate (l3_next->input_next_by_type, ethertype);
1298 /* Rebuild next index -> sparse index inverse mapping when sparse vector
1300 vec_validate (l3_next->sparse_index_by_input_next_index, next_index);
1301 for (i = 1; i < vec_len (l3_next->input_next_by_type); i++)
1303 sparse_index_by_input_next_index[l3_next->input_next_by_type[i]] = i;
1305 // do not allow the cached next index's to be updated if L3
1306 // redirect is enabled, as it will have overwritten them
1307 if (!em->redirect_l3)
1309 // Cache common ethertypes directly
1310 if (ethertype == ETHERNET_TYPE_IP4)
1312 l3_next->input_next_ip4 = next_index;
1314 else if (ethertype == ETHERNET_TYPE_IP6)
1316 l3_next->input_next_ip6 = next_index;
1318 else if (ethertype == ETHERNET_TYPE_MPLS)
1320 l3_next->input_next_mpls = next_index;
1327 static clib_error_t *
1328 ethernet_input_init (vlib_main_t * vm)
1330 ethernet_main_t *em = ðernet_main;
1331 __attribute__ ((unused)) vlan_table_t *invalid_vlan_table;
1332 __attribute__ ((unused)) qinq_table_t *invalid_qinq_table;
1334 ethernet_setup_node (vm, ethernet_input_node.index);
1335 ethernet_setup_node (vm, ethernet_input_type_node.index);
1336 ethernet_setup_node (vm, ethernet_input_not_l2_node.index);
1338 next_by_ethertype_init (&em->l3_next);
1340 // Initialize pools and vector for vlan parsing
1341 vec_validate (em->main_intfs, 10); // 10 main interfaces
1342 pool_alloc (em->vlan_pool, 10);
1343 pool_alloc (em->qinq_pool, 1);
1345 // The first vlan pool will always be reserved for an invalid table
1346 pool_get (em->vlan_pool, invalid_vlan_table); // first id = 0
1347 // The first qinq pool will always be reserved for an invalid table
1348 pool_get (em->qinq_pool, invalid_qinq_table); // first id = 0
1353 VLIB_INIT_FUNCTION (ethernet_input_init);
1356 ethernet_register_input_type (vlib_main_t * vm,
1357 ethernet_type_t type, u32 node_index)
1359 ethernet_main_t *em = ðernet_main;
1360 ethernet_type_info_t *ti;
1364 clib_error_t *error = vlib_call_init_function (vm, ethernet_init);
1366 clib_error_report (error);
1369 ti = ethernet_get_type_info (em, type);
1370 ti->node_index = node_index;
1371 ti->next_index = vlib_node_add_next (vm,
1372 ethernet_input_node.index, node_index);
1373 i = vlib_node_add_next (vm, ethernet_input_type_node.index, node_index);
1374 ASSERT (i == ti->next_index);
1376 i = vlib_node_add_next (vm, ethernet_input_not_l2_node.index, node_index);
1377 ASSERT (i == ti->next_index);
1379 // Add the L3 node for this ethertype to the next nodes structure
1380 next_by_ethertype_register (&em->l3_next, type, ti->next_index);
1382 // Call the registration functions for other nodes that want a mapping
1383 l2bvi_register_input_type (vm, type, node_index);
1387 ethernet_register_l2_input (vlib_main_t * vm, u32 node_index)
1389 ethernet_main_t *em = ðernet_main;
1393 vlib_node_add_next (vm, ethernet_input_node.index, node_index);
1396 * Even if we never use these arcs, we have to align the next indices...
1398 i = vlib_node_add_next (vm, ethernet_input_type_node.index, node_index);
1400 ASSERT (i == em->l2_next);
1402 i = vlib_node_add_next (vm, ethernet_input_not_l2_node.index, node_index);
1403 ASSERT (i == em->l2_next);
1406 // Register a next node for L3 redirect, and enable L3 redirect
1408 ethernet_register_l3_redirect (vlib_main_t * vm, u32 node_index)
1410 ethernet_main_t *em = ðernet_main;
1413 em->redirect_l3 = 1;
1414 em->redirect_l3_next = vlib_node_add_next (vm,
1415 ethernet_input_node.index,
1418 * Change the cached next nodes to the redirect node
1420 em->l3_next.input_next_ip4 = em->redirect_l3_next;
1421 em->l3_next.input_next_ip6 = em->redirect_l3_next;
1422 em->l3_next.input_next_mpls = em->redirect_l3_next;
1425 * Even if we never use these arcs, we have to align the next indices...
1427 i = vlib_node_add_next (vm, ethernet_input_type_node.index, node_index);
1429 ASSERT (i == em->redirect_l3_next);
1431 i = vlib_node_add_next (vm, ethernet_input_not_l2_node.index, node_index);
1433 ASSERT (i == em->redirect_l3_next);
1437 * fd.io coding-style-patch-verification: ON
1440 * eval: (c-set-style "gnu")