blob: 55d8285f81ed79f389a2fd34d32845b192e14b28 [file] [log] [blame]
Ed Warnickecb9cada2015-12-08 15:45:58 -07001/*
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>
Pavel Kotucek15ac81c2017-06-20 14:00:26 +020043#include <vnet/ethernet/p2p_ethernet.h>
Ed Warnickecb9cada2015-12-08 15:45:58 -070044#include <vppinfra/sparse_vec.h>
45#include <vnet/l2/l2_bvi.h>
46
47
48#define foreach_ethernet_input_next \
49 _ (PUNT, "error-punt") \
50 _ (DROP, "error-drop") \
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -070051 _ (LLC, "llc-input")
Ed Warnickecb9cada2015-12-08 15:45:58 -070052
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -070053typedef enum
54{
Ed Warnickecb9cada2015-12-08 15:45:58 -070055#define _(s,n) ETHERNET_INPUT_NEXT_##s,
56 foreach_ethernet_input_next
57#undef _
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -070058 ETHERNET_INPUT_N_NEXT,
Ed Warnickecb9cada2015-12-08 15:45:58 -070059} ethernet_input_next_t;
60
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -070061typedef struct
62{
Ed Warnickecb9cada2015-12-08 15:45:58 -070063 u8 packet_data[32];
64} ethernet_input_trace_t;
65
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -070066static u8 *
67format_ethernet_input_trace (u8 * s, va_list * va)
Ed Warnickecb9cada2015-12-08 15:45:58 -070068{
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 *);
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -070071 ethernet_input_trace_t *t = va_arg (*va, ethernet_input_trace_t *);
Ed Warnickecb9cada2015-12-08 15:45:58 -070072
73 s = format (s, "%U", format_ethernet_header, t->packet_data);
74
75 return s;
76}
77
78vlib_node_registration_t ethernet_input_node;
79
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -070080typedef enum
81{
Ed Warnickecb9cada2015-12-08 15:45:58 -070082 ETHERNET_INPUT_VARIANT_ETHERNET,
83 ETHERNET_INPUT_VARIANT_ETHERNET_TYPE,
Ed Warnickecb9cada2015-12-08 15:45:58 -070084 ETHERNET_INPUT_VARIANT_NOT_L2,
85} ethernet_input_variant_t;
86
87
Ed Warnickecb9cada2015-12-08 15:45:58 -070088// Parse the ethernet header to extract vlan tags and innermost ethertype
89static_always_inline void
90parse_header (ethernet_input_variant_t variant,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -070091 vlib_buffer_t * b0,
92 u16 * type,
93 u16 * orig_type,
94 u16 * outer_id, u16 * inner_id, u32 * match_flags)
95{
Chris Luke194ebc52016-04-25 14:26:55 -040096 u8 vlan_count;
Ed Warnickecb9cada2015-12-08 15:45:58 -070097
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -070098 if (variant == ETHERNET_INPUT_VARIANT_ETHERNET
99 || variant == ETHERNET_INPUT_VARIANT_NOT_L2)
100 {
101 ethernet_header_t *e0;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700102
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700103 e0 = (void *) (b0->data + b0->current_data);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700104
Damjan Marion072401e2017-07-13 18:53:27 +0200105 vnet_buffer (b0)->l2_hdr_offset = b0->current_data;
Steven35de3b32017-12-03 23:40:54 -0800106 b0->flags |= VNET_BUFFER_F_L2_HDR_OFFSET_VALID;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700107
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700108 vlib_buffer_advance (b0, sizeof (e0[0]));
Ed Warnickecb9cada2015-12-08 15:45:58 -0700109
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700110 *type = clib_net_to_host_u16 (e0->type);
111 }
112 else if (variant == ETHERNET_INPUT_VARIANT_ETHERNET_TYPE)
113 {
114 // here when prior node was LLC/SNAP processing
115 u16 *e0;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700116
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700117 e0 = (void *) (b0->data + b0->current_data);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700118
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700119 vlib_buffer_advance (b0, sizeof (e0[0]));
Ed Warnickecb9cada2015-12-08 15:45:58 -0700120
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700121 *type = clib_net_to_host_u16 (e0[0]);
122 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700123
124 // save for distinguishing between dot1q and dot1ad later
125 *orig_type = *type;
126
127 // default the tags to 0 (used if there is no corresponding tag)
128 *outer_id = 0;
129 *inner_id = 0;
130
131 *match_flags = SUBINT_CONFIG_VALID | SUBINT_CONFIG_MATCH_0_TAG;
Chris Luke194ebc52016-04-25 14:26:55 -0400132 vlan_count = 0;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700133
134 // check for vlan encaps
Damjan Marionb94bdad2016-09-19 11:32:03 +0200135 if (ethernet_frame_is_tagged (*type))
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700136 {
137 ethernet_vlan_header_t *h0;
138 u16 tag;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700139
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700140 *match_flags = SUBINT_CONFIG_VALID | SUBINT_CONFIG_MATCH_1_TAG;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700141
142 h0 = (void *) (b0->data + b0->current_data);
143
144 tag = clib_net_to_host_u16 (h0->priority_cfi_and_id);
145
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700146 *outer_id = tag & 0xfff;
Neale Ranns30d0fd42017-05-30 07:30:04 -0700147 if (0 == *outer_id)
148 *match_flags &= ~SUBINT_CONFIG_MATCH_1_TAG;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700149
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700150 *type = clib_net_to_host_u16 (h0->type);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700151
152 vlib_buffer_advance (b0, sizeof (h0[0]));
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700153 vlan_count = 1;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700154
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700155 if (*type == ETHERNET_TYPE_VLAN)
156 {
157 // Double tagged packet
158 *match_flags = SUBINT_CONFIG_VALID | SUBINT_CONFIG_MATCH_2_TAG;
159
160 h0 = (void *) (b0->data + b0->current_data);
161
162 tag = clib_net_to_host_u16 (h0->priority_cfi_and_id);
163
164 *inner_id = tag & 0xfff;
165
166 *type = clib_net_to_host_u16 (h0->type);
167
168 vlib_buffer_advance (b0, sizeof (h0[0]));
169 vlan_count = 2;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700170 if (*type == ETHERNET_TYPE_VLAN)
171 {
172 // More than double tagged packet
173 *match_flags = SUBINT_CONFIG_VALID | SUBINT_CONFIG_MATCH_3_TAG;
Eyal Bari6f7ebf92017-06-13 12:09:37 +0300174
175 vlib_buffer_advance (b0, sizeof (h0[0]));
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700176 vlan_count = 3; // "unknown" number, aka, 3-or-more
177 }
178 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700179 }
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700180 ethernet_buffer_set_vlan_count (b0, vlan_count);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700181}
182
183// Determine the subinterface for this packet, given the result of the
184// vlan table lookups and vlan header parsing. Check the most specific
185// matches first.
186static_always_inline void
187identify_subint (vnet_hw_interface_t * hi,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700188 vlib_buffer_t * b0,
189 u32 match_flags,
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)
Ed Warnickecb9cada2015-12-08 15:45:58 -0700194{
195 u32 matched;
196
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700197 matched = eth_identify_subint (hi, b0, match_flags,
198 main_intf, vlan_intf, qinq_intf,
199 new_sw_if_index, error0, is_l2);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700200
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700201 if (matched)
202 {
Ed Warnickecb9cada2015-12-08 15:45:58 -0700203
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700204 // 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.
207 if (!(*is_l2))
208 {
209 ethernet_header_t *e0;
Damjan Marion072401e2017-07-13 18:53:27 +0200210 e0 = (void *) (b0->data + vnet_buffer (b0)->l2_hdr_offset);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700211
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700212 if (!(ethernet_address_cast (e0->dst_address)))
213 {
214 if (!eth_mac_equal ((u8 *) e0, hi->hw_address))
215 {
216 *error0 = ETHERNET_ERROR_L3_MAC_MISMATCH;
217 }
218 }
219 }
220
221 // Check for down subinterface
222 *error0 = (*new_sw_if_index) != ~0 ? (*error0) : ETHERNET_ERROR_DOWN;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700223 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700224}
225
226static_always_inline void
227determine_next_node (ethernet_main_t * em,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700228 ethernet_input_variant_t variant,
229 u32 is_l20,
230 u32 type0, vlib_buffer_t * b0, u8 * error0, u8 * next0)
Ed Warnickecb9cada2015-12-08 15:45:58 -0700231{
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700232 if (PREDICT_FALSE (*error0 != ETHERNET_ERROR_NONE))
233 {
234 // some error occurred
235 *next0 = ETHERNET_INPUT_NEXT_DROP;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700236 }
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700237 else if (is_l20)
238 {
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700239 // record the L2 len and reset the buffer so the L2 header is preserved
John Lob14826e2018-04-18 15:52:23 -0400240 u32 eth_start = vnet_buffer (b0)->l2_hdr_offset;
241 vnet_buffer (b0)->l2.l2_len = b0->current_data - eth_start;
242 *next0 = em->l2_next;
Eyal Bari6f7ebf92017-06-13 12:09:37 +0300243 ASSERT (vnet_buffer (b0)->l2.l2_len ==
244 ethernet_buffer_header_size (b0));
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700245 vlib_buffer_advance (b0, -ethernet_buffer_header_size (b0));
246
247 // check for common IP/MPLS ethertypes
248 }
249 else if (type0 == ETHERNET_TYPE_IP4)
250 {
251 *next0 = em->l3_next.input_next_ip4;
252 }
253 else if (type0 == ETHERNET_TYPE_IP6)
254 {
255 *next0 = em->l3_next.input_next_ip6;
256 }
Neale Ranns0f26c5a2017-03-01 15:12:11 -0800257 else if (type0 == ETHERNET_TYPE_MPLS)
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700258 {
259 *next0 = em->l3_next.input_next_mpls;
260
261 }
262 else if (em->redirect_l3)
263 {
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;
267 }
268 else
269 {
270 // uncommon ethertype, check table
271 u32 i0;
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);
274 *error0 =
275 i0 ==
276 SPARSE_VEC_INVALID_INDEX ? ETHERNET_ERROR_UNKNOWN_TYPE : *error0;
277
278 // The table is not populated with LLC values, so check that now.
Damjan Marion607de1a2016-08-16 22:53:54 +0200279 // If variant is variant_ethernet then we came from LLC processing. Don't
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700280 // go back there; drop instead using by keeping the drop/bad table result.
281 if ((type0 < 0x600) && (variant == ETHERNET_INPUT_VARIANT_ETHERNET))
282 {
283 *next0 = ETHERNET_INPUT_NEXT_LLC;
284 }
285 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700286}
287
288static_always_inline uword
289ethernet_input_inline (vlib_main_t * vm,
290 vlib_node_runtime_t * node,
291 vlib_frame_t * from_frame,
292 ethernet_input_variant_t variant)
293{
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700294 vnet_main_t *vnm = vnet_get_main ();
295 ethernet_main_t *em = &ethernet_main;
296 vlib_node_runtime_t *error_node;
297 u32 n_left_from, next_index, *from, *to_next;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700298 u32 stats_sw_if_index, stats_n_packets, stats_n_bytes;
Damjan Marion586afd72017-04-05 19:18:20 +0200299 u32 thread_index = vlib_get_thread_index ();
Dave Barachcfba1e22016-11-16 10:23:50 -0500300 u32 cached_sw_if_index = ~0;
301 u32 cached_is_l2 = 0; /* shut up gcc */
John Lo1904c472017-03-10 17:15:22 -0500302 vnet_hw_interface_t *hi = NULL; /* used for main interface only */
Ed Warnickecb9cada2015-12-08 15:45:58 -0700303
304 if (variant != ETHERNET_INPUT_VARIANT_ETHERNET)
305 error_node = vlib_node_get_runtime (vm, ethernet_input_node.index);
306 else
307 error_node = node;
308
309 from = vlib_frame_vector_args (from_frame);
310 n_left_from = from_frame->n_vectors;
311
312 if (node->flags & VLIB_NODE_FLAG_TRACE)
313 vlib_trace_frame_buffers_only (vm, node,
314 from,
315 n_left_from,
316 sizeof (from[0]),
317 sizeof (ethernet_input_trace_t));
318
319 next_index = node->cached_next_index;
320 stats_sw_if_index = node->runtime_data[0];
321 stats_n_packets = stats_n_bytes = 0;
322
323 while (n_left_from > 0)
324 {
325 u32 n_left_to_next;
326
327 vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
328
329 while (n_left_from >= 4 && n_left_to_next >= 2)
330 {
331 u32 bi0, bi1;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700332 vlib_buffer_t *b0, *b1;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700333 u8 next0, next1, error0, error1;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700334 u16 type0, orig_type0, type1, orig_type1;
335 u16 outer_id0, inner_id0, outer_id1, inner_id1;
336 u32 match_flags0, match_flags1;
337 u32 old_sw_if_index0, new_sw_if_index0, len0, old_sw_if_index1,
338 new_sw_if_index1, len1;
339 vnet_hw_interface_t *hi0, *hi1;
340 main_intf_t *main_intf0, *main_intf1;
341 vlan_intf_t *vlan_intf0, *vlan_intf1;
342 qinq_intf_t *qinq_intf0, *qinq_intf1;
343 u32 is_l20, is_l21;
Dave Barachcfba1e22016-11-16 10:23:50 -0500344 ethernet_header_t *e0, *e1;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700345
346 /* Prefetch next iteration. */
347 {
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700348 vlib_buffer_t *b2, *b3;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700349
350 b2 = vlib_get_buffer (vm, from[2]);
351 b3 = vlib_get_buffer (vm, from[3]);
352
353 vlib_prefetch_buffer_header (b2, STORE);
354 vlib_prefetch_buffer_header (b3, STORE);
355
356 CLIB_PREFETCH (b2->data, sizeof (ethernet_header_t), LOAD);
357 CLIB_PREFETCH (b3->data, sizeof (ethernet_header_t), LOAD);
358 }
359
360 bi0 = from[0];
361 bi1 = from[1];
362 to_next[0] = bi0;
363 to_next[1] = bi1;
364 from += 2;
365 to_next += 2;
366 n_left_to_next -= 2;
367 n_left_from -= 2;
368
369 b0 = vlib_get_buffer (vm, bi0);
370 b1 = vlib_get_buffer (vm, bi1);
371
372 error0 = error1 = ETHERNET_ERROR_NONE;
Dave Barachcfba1e22016-11-16 10:23:50 -0500373 e0 = vlib_buffer_get_current (b0);
374 type0 = clib_net_to_host_u16 (e0->type);
375 e1 = vlib_buffer_get_current (b1);
376 type1 = clib_net_to_host_u16 (e1->type);
377
John Locc532852016-12-14 15:42:45 -0500378 /* Speed-path for the untagged case */
Dave Barachcfba1e22016-11-16 10:23:50 -0500379 if (PREDICT_TRUE (variant == ETHERNET_INPUT_VARIANT_ETHERNET
Damjan Marionc6969b52018-02-19 12:14:06 +0100380 && !ethernet_frame_is_any_tagged_x2 (type0,
381 type1)))
Dave Barachcfba1e22016-11-16 10:23:50 -0500382 {
383 main_intf_t *intf0;
384 subint_config_t *subint0;
385 u32 sw_if_index0, sw_if_index1;
386
387 sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
388 sw_if_index1 = vnet_buffer (b1)->sw_if_index[VLIB_RX];
389 is_l20 = cached_is_l2;
390
391 /* This is probably wholly unnecessary */
392 if (PREDICT_FALSE (sw_if_index0 != sw_if_index1))
393 goto slowpath;
394
John Lo1904c472017-03-10 17:15:22 -0500395 /* Now sw_if_index0 == sw_if_index1 */
Dave Barachcfba1e22016-11-16 10:23:50 -0500396 if (PREDICT_FALSE (cached_sw_if_index != sw_if_index0))
397 {
398 cached_sw_if_index = sw_if_index0;
John Lo1904c472017-03-10 17:15:22 -0500399 hi = vnet_get_sup_hw_interface (vnm, sw_if_index0);
400 intf0 = vec_elt_at_index (em->main_intfs, hi->hw_if_index);
Dave Barachcfba1e22016-11-16 10:23:50 -0500401 subint0 = &intf0->untagged_subint;
402 cached_is_l2 = is_l20 = subint0->flags & SUBINT_CONFIG_L2;
403 }
John Lo7714b302016-12-20 16:59:02 -0500404
Damjan Marion072401e2017-07-13 18:53:27 +0200405 vnet_buffer (b0)->l2_hdr_offset = b0->current_data;
406 vnet_buffer (b1)->l2_hdr_offset = b1->current_data;
Steven35de3b32017-12-03 23:40:54 -0800407 vnet_buffer (b0)->l3_hdr_offset =
408 vnet_buffer (b0)->l2_hdr_offset + sizeof (ethernet_header_t);
409 vnet_buffer (b1)->l3_hdr_offset =
410 vnet_buffer (b1)->l2_hdr_offset + sizeof (ethernet_header_t);
411 b0->flags |= VNET_BUFFER_F_L2_HDR_OFFSET_VALID |
412 VNET_BUFFER_F_L3_HDR_OFFSET_VALID;
413 b1->flags |= VNET_BUFFER_F_L2_HDR_OFFSET_VALID |
414 VNET_BUFFER_F_L3_HDR_OFFSET_VALID;
John Lo7714b302016-12-20 16:59:02 -0500415
Dave Barachcfba1e22016-11-16 10:23:50 -0500416 if (PREDICT_TRUE (is_l20 != 0))
417 {
418 next0 = em->l2_next;
419 vnet_buffer (b0)->l2.l2_len = sizeof (ethernet_header_t);
Dave Barachcfba1e22016-11-16 10:23:50 -0500420 next1 = em->l2_next;
421 vnet_buffer (b1)->l2.l2_len = sizeof (ethernet_header_t);
Dave Barachcfba1e22016-11-16 10:23:50 -0500422 }
John Locc532852016-12-14 15:42:45 -0500423 else
424 {
John Lo1904c472017-03-10 17:15:22 -0500425 if (!ethernet_address_cast (e0->dst_address) &&
Hongjun Ni9e3e3612017-04-26 18:40:55 +0800426 (hi->hw_address != 0) &&
John Lo1904c472017-03-10 17:15:22 -0500427 !eth_mac_equal ((u8 *) e0, hi->hw_address))
428 error0 = ETHERNET_ERROR_L3_MAC_MISMATCH;
429 if (!ethernet_address_cast (e1->dst_address) &&
Hongjun Ni9e3e3612017-04-26 18:40:55 +0800430 (hi->hw_address != 0) &&
John Lo1904c472017-03-10 17:15:22 -0500431 !eth_mac_equal ((u8 *) e1, hi->hw_address))
432 error1 = ETHERNET_ERROR_L3_MAC_MISMATCH;
John Lob14826e2018-04-18 15:52:23 -0400433 vlib_buffer_advance (b0, sizeof (ethernet_header_t));
John Locc532852016-12-14 15:42:45 -0500434 determine_next_node (em, variant, 0, type0, b0,
435 &error0, &next0);
John Lob14826e2018-04-18 15:52:23 -0400436 vlib_buffer_advance (b1, sizeof (ethernet_header_t));
John Locc532852016-12-14 15:42:45 -0500437 determine_next_node (em, variant, 0, type1, b1,
438 &error1, &next1);
John Locc532852016-12-14 15:42:45 -0500439 }
440 goto ship_it01;
Dave Barachcfba1e22016-11-16 10:23:50 -0500441 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700442
John Locc532852016-12-14 15:42:45 -0500443 /* Slow-path for the tagged case */
444 slowpath:
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700445 parse_header (variant,
446 b0,
447 &type0,
448 &orig_type0, &outer_id0, &inner_id0, &match_flags0);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700449
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700450 parse_header (variant,
451 b1,
452 &type1,
453 &orig_type1, &outer_id1, &inner_id1, &match_flags1);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700454
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700455 old_sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
456 old_sw_if_index1 = vnet_buffer (b1)->sw_if_index[VLIB_RX];
Ed Warnickecb9cada2015-12-08 15:45:58 -0700457
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700458 eth_vlan_table_lookups (em,
459 vnm,
460 old_sw_if_index0,
461 orig_type0,
462 outer_id0,
463 inner_id0,
464 &hi0,
465 &main_intf0, &vlan_intf0, &qinq_intf0);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700466
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700467 eth_vlan_table_lookups (em,
468 vnm,
469 old_sw_if_index1,
470 orig_type1,
471 outer_id1,
472 inner_id1,
473 &hi1,
474 &main_intf1, &vlan_intf1, &qinq_intf1);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700475
476 identify_subint (hi0,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700477 b0,
478 match_flags0,
479 main_intf0,
480 vlan_intf0,
481 qinq_intf0, &new_sw_if_index0, &error0, &is_l20);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700482
483 identify_subint (hi1,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700484 b1,
485 match_flags1,
486 main_intf1,
487 vlan_intf1,
488 qinq_intf1, &new_sw_if_index1, &error1, &is_l21);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700489
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700490 // Save RX sw_if_index for later nodes
491 vnet_buffer (b0)->sw_if_index[VLIB_RX] =
492 error0 !=
493 ETHERNET_ERROR_NONE ? old_sw_if_index0 : new_sw_if_index0;
494 vnet_buffer (b1)->sw_if_index[VLIB_RX] =
495 error1 !=
496 ETHERNET_ERROR_NONE ? old_sw_if_index1 : new_sw_if_index1;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700497
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700498 // Check if there is a stat to take (valid and non-main sw_if_index for pkt 0 or pkt 1)
499 if (((new_sw_if_index0 != ~0)
500 && (new_sw_if_index0 != old_sw_if_index0))
501 || ((new_sw_if_index1 != ~0)
502 && (new_sw_if_index1 != old_sw_if_index1)))
503 {
Ed Warnickecb9cada2015-12-08 15:45:58 -0700504
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700505 len0 = vlib_buffer_length_in_chain (vm, b0) + b0->current_data
Damjan Marion072401e2017-07-13 18:53:27 +0200506 - vnet_buffer (b0)->l2_hdr_offset;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700507 len1 = vlib_buffer_length_in_chain (vm, b1) + b1->current_data
Damjan Marion072401e2017-07-13 18:53:27 +0200508 - vnet_buffer (b1)->l2_hdr_offset;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700509
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700510 stats_n_packets += 2;
511 stats_n_bytes += len0 + len1;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700512
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700513 if (PREDICT_FALSE
514 (!(new_sw_if_index0 == stats_sw_if_index
515 && new_sw_if_index1 == stats_sw_if_index)))
Ed Warnickecb9cada2015-12-08 15:45:58 -0700516 {
517 stats_n_packets -= 2;
518 stats_n_bytes -= len0 + len1;
519
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700520 if (new_sw_if_index0 != old_sw_if_index0
521 && new_sw_if_index0 != ~0)
522 vlib_increment_combined_counter (vnm->
523 interface_main.combined_sw_if_counters
524 +
525 VNET_INTERFACE_COUNTER_RX,
Damjan Marion586afd72017-04-05 19:18:20 +0200526 thread_index,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700527 new_sw_if_index0, 1,
528 len0);
529 if (new_sw_if_index1 != old_sw_if_index1
530 && new_sw_if_index1 != ~0)
531 vlib_increment_combined_counter (vnm->
532 interface_main.combined_sw_if_counters
533 +
534 VNET_INTERFACE_COUNTER_RX,
Damjan Marion586afd72017-04-05 19:18:20 +0200535 thread_index,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700536 new_sw_if_index1, 1,
537 len1);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700538
539 if (new_sw_if_index0 == new_sw_if_index1)
540 {
541 if (stats_n_packets > 0)
542 {
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700543 vlib_increment_combined_counter
544 (vnm->interface_main.combined_sw_if_counters
545 + VNET_INTERFACE_COUNTER_RX,
Damjan Marion586afd72017-04-05 19:18:20 +0200546 thread_index,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700547 stats_sw_if_index,
548 stats_n_packets, stats_n_bytes);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700549 stats_n_packets = stats_n_bytes = 0;
550 }
551 stats_sw_if_index = new_sw_if_index0;
552 }
553 }
554 }
555
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700556 if (variant == ETHERNET_INPUT_VARIANT_NOT_L2)
557 is_l20 = is_l21 = 0;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700558
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700559 determine_next_node (em, variant, is_l20, type0, b0, &error0,
560 &next0);
561 determine_next_node (em, variant, is_l21, type1, b1, &error1,
562 &next1);
Steven35de3b32017-12-03 23:40:54 -0800563 vnet_buffer (b0)->l3_hdr_offset = vnet_buffer (b0)->l2_hdr_offset +
564 vnet_buffer (b0)->l2.l2_len;
565 vnet_buffer (b1)->l3_hdr_offset = vnet_buffer (b1)->l2_hdr_offset +
566 vnet_buffer (b1)->l2.l2_len;
567 b0->flags |= VNET_BUFFER_F_L3_HDR_OFFSET_VALID;
568 b1->flags |= VNET_BUFFER_F_L3_HDR_OFFSET_VALID;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700569
John Lo1904c472017-03-10 17:15:22 -0500570 ship_it01:
Ed Warnickecb9cada2015-12-08 15:45:58 -0700571 b0->error = error_node->errors[error0];
572 b1->error = error_node->errors[error1];
573
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700574 // verify speculative enqueue
575 vlib_validate_buffer_enqueue_x2 (vm, node, next_index, to_next,
576 n_left_to_next, bi0, bi1, next0,
577 next1);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700578 }
579
580 while (n_left_from > 0 && n_left_to_next > 0)
581 {
582 u32 bi0;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700583 vlib_buffer_t *b0;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700584 u8 error0, next0;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700585 u16 type0, orig_type0;
586 u16 outer_id0, inner_id0;
587 u32 match_flags0;
588 u32 old_sw_if_index0, new_sw_if_index0, len0;
589 vnet_hw_interface_t *hi0;
590 main_intf_t *main_intf0;
591 vlan_intf_t *vlan_intf0;
592 qinq_intf_t *qinq_intf0;
Dave Barachcfba1e22016-11-16 10:23:50 -0500593 ethernet_header_t *e0;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700594 u32 is_l20;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700595
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700596 // Prefetch next iteration
597 if (n_left_from > 1)
598 {
599 vlib_buffer_t *p2;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700600
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700601 p2 = vlib_get_buffer (vm, from[1]);
602 vlib_prefetch_buffer_header (p2, STORE);
603 CLIB_PREFETCH (p2->data, CLIB_CACHE_LINE_BYTES, LOAD);
604 }
605
606 bi0 = from[0];
Ed Warnickecb9cada2015-12-08 15:45:58 -0700607 to_next[0] = bi0;
608 from += 1;
609 to_next += 1;
610 n_left_from -= 1;
611 n_left_to_next -= 1;
612
613 b0 = vlib_get_buffer (vm, bi0);
614
615 error0 = ETHERNET_ERROR_NONE;
Dave Barachcfba1e22016-11-16 10:23:50 -0500616 e0 = vlib_buffer_get_current (b0);
617 type0 = clib_net_to_host_u16 (e0->type);
618
John Locc532852016-12-14 15:42:45 -0500619 /* Speed-path for the untagged case */
Dave Barachcfba1e22016-11-16 10:23:50 -0500620 if (PREDICT_TRUE (variant == ETHERNET_INPUT_VARIANT_ETHERNET
621 && !ethernet_frame_is_tagged (type0)))
622 {
623 main_intf_t *intf0;
624 subint_config_t *subint0;
625 u32 sw_if_index0;
626
627 sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
628 is_l20 = cached_is_l2;
629
630 if (PREDICT_FALSE (cached_sw_if_index != sw_if_index0))
631 {
632 cached_sw_if_index = sw_if_index0;
John Lo1904c472017-03-10 17:15:22 -0500633 hi = vnet_get_sup_hw_interface (vnm, sw_if_index0);
634 intf0 = vec_elt_at_index (em->main_intfs, hi->hw_if_index);
Dave Barachcfba1e22016-11-16 10:23:50 -0500635 subint0 = &intf0->untagged_subint;
636 cached_is_l2 = is_l20 = subint0->flags & SUBINT_CONFIG_L2;
637 }
John Lo7714b302016-12-20 16:59:02 -0500638
Damjan Marion072401e2017-07-13 18:53:27 +0200639 vnet_buffer (b0)->l2_hdr_offset = b0->current_data;
Steven35de3b32017-12-03 23:40:54 -0800640 vnet_buffer (b0)->l3_hdr_offset =
641 vnet_buffer (b0)->l2_hdr_offset + sizeof (ethernet_header_t);
642 b0->flags |= VNET_BUFFER_F_L2_HDR_OFFSET_VALID |
643 VNET_BUFFER_F_L3_HDR_OFFSET_VALID;
John Lo7714b302016-12-20 16:59:02 -0500644
Dave Barachcfba1e22016-11-16 10:23:50 -0500645 if (PREDICT_TRUE (is_l20 != 0))
646 {
647 next0 = em->l2_next;
648 vnet_buffer (b0)->l2.l2_len = sizeof (ethernet_header_t);
Dave Barachcfba1e22016-11-16 10:23:50 -0500649 }
John Locc532852016-12-14 15:42:45 -0500650 else
651 {
John Lo1904c472017-03-10 17:15:22 -0500652 if (!ethernet_address_cast (e0->dst_address) &&
Hongjun Ni9e3e3612017-04-26 18:40:55 +0800653 (hi->hw_address != 0) &&
John Lo1904c472017-03-10 17:15:22 -0500654 !eth_mac_equal ((u8 *) e0, hi->hw_address))
655 error0 = ETHERNET_ERROR_L3_MAC_MISMATCH;
John Locc532852016-12-14 15:42:45 -0500656 determine_next_node (em, variant, 0, type0, b0,
657 &error0, &next0);
658 vlib_buffer_advance (b0, sizeof (ethernet_header_t));
659 }
660 goto ship_it0;
Dave Barachcfba1e22016-11-16 10:23:50 -0500661 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700662
John Locc532852016-12-14 15:42:45 -0500663 /* Slow-path for the tagged case */
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700664 parse_header (variant,
665 b0,
666 &type0,
667 &orig_type0, &outer_id0, &inner_id0, &match_flags0);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700668
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700669 old_sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
Ed Warnickecb9cada2015-12-08 15:45:58 -0700670
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700671 eth_vlan_table_lookups (em,
672 vnm,
673 old_sw_if_index0,
674 orig_type0,
675 outer_id0,
676 inner_id0,
677 &hi0,
678 &main_intf0, &vlan_intf0, &qinq_intf0);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700679
680 identify_subint (hi0,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700681 b0,
682 match_flags0,
683 main_intf0,
684 vlan_intf0,
685 qinq_intf0, &new_sw_if_index0, &error0, &is_l20);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700686
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700687 // Save RX sw_if_index for later nodes
688 vnet_buffer (b0)->sw_if_index[VLIB_RX] =
689 error0 !=
690 ETHERNET_ERROR_NONE ? old_sw_if_index0 : new_sw_if_index0;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700691
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700692 // Increment subinterface stats
693 // Note that interface-level counters have already been incremented
694 // prior to calling this function. Thus only subinterface counters
695 // are incremented here.
696 //
Damjan Marion607de1a2016-08-16 22:53:54 +0200697 // Interface level counters include packets received on the main
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700698 // interface and all subinterfaces. Subinterface level counters
699 // include only those packets received on that subinterface
Ed Warnickecb9cada2015-12-08 15:45:58 -0700700 // Increment stats if the subint is valid and it is not the main intf
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700701 if ((new_sw_if_index0 != ~0)
702 && (new_sw_if_index0 != old_sw_if_index0))
703 {
Ed Warnickecb9cada2015-12-08 15:45:58 -0700704
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700705 len0 = vlib_buffer_length_in_chain (vm, b0) + b0->current_data
Damjan Marion072401e2017-07-13 18:53:27 +0200706 - vnet_buffer (b0)->l2_hdr_offset;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700707
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700708 stats_n_packets += 1;
709 stats_n_bytes += len0;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700710
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700711 // Batch stat increments from the same subinterface so counters
Damjan Marion607de1a2016-08-16 22:53:54 +0200712 // don't need to be incremented for every packet.
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700713 if (PREDICT_FALSE (new_sw_if_index0 != stats_sw_if_index))
714 {
715 stats_n_packets -= 1;
716 stats_n_bytes -= len0;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700717
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700718 if (new_sw_if_index0 != ~0)
719 vlib_increment_combined_counter
720 (vnm->interface_main.combined_sw_if_counters
721 + VNET_INTERFACE_COUNTER_RX,
Damjan Marion586afd72017-04-05 19:18:20 +0200722 thread_index, new_sw_if_index0, 1, len0);
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700723 if (stats_n_packets > 0)
724 {
725 vlib_increment_combined_counter
726 (vnm->interface_main.combined_sw_if_counters
727 + VNET_INTERFACE_COUNTER_RX,
Damjan Marion586afd72017-04-05 19:18:20 +0200728 thread_index,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700729 stats_sw_if_index, stats_n_packets, stats_n_bytes);
730 stats_n_packets = stats_n_bytes = 0;
731 }
732 stats_sw_if_index = new_sw_if_index0;
733 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700734 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700735
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700736 if (variant == ETHERNET_INPUT_VARIANT_NOT_L2)
737 is_l20 = 0;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700738
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700739 determine_next_node (em, variant, is_l20, type0, b0, &error0,
740 &next0);
Steven35de3b32017-12-03 23:40:54 -0800741 vnet_buffer (b0)->l3_hdr_offset = vnet_buffer (b0)->l2_hdr_offset +
742 vnet_buffer (b0)->l2.l2_len;
743 b0->flags |= VNET_BUFFER_F_L3_HDR_OFFSET_VALID;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700744
John Lo1904c472017-03-10 17:15:22 -0500745 ship_it0:
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700746 b0->error = error_node->errors[error0];
747
748 // verify speculative enqueue
Ed Warnickecb9cada2015-12-08 15:45:58 -0700749 vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
750 to_next, n_left_to_next,
751 bi0, next0);
752 }
753
754 vlib_put_next_frame (vm, node, next_index, n_left_to_next);
755 }
756
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700757 // Increment any remaining batched stats
758 if (stats_n_packets > 0)
Ed Warnickecb9cada2015-12-08 15:45:58 -0700759 {
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700760 vlib_increment_combined_counter
761 (vnm->interface_main.combined_sw_if_counters
762 + VNET_INTERFACE_COUNTER_RX,
Damjan Marion586afd72017-04-05 19:18:20 +0200763 thread_index, stats_sw_if_index, stats_n_packets, stats_n_bytes);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700764 node->runtime_data[0] = stats_sw_if_index;
765 }
766
767 return from_frame->n_vectors;
768}
769
770static uword
771ethernet_input (vlib_main_t * vm,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700772 vlib_node_runtime_t * node, vlib_frame_t * from_frame)
773{
774 return ethernet_input_inline (vm, node, from_frame,
775 ETHERNET_INPUT_VARIANT_ETHERNET);
776}
Ed Warnickecb9cada2015-12-08 15:45:58 -0700777
778static uword
779ethernet_input_type (vlib_main_t * vm,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700780 vlib_node_runtime_t * node, vlib_frame_t * from_frame)
781{
782 return ethernet_input_inline (vm, node, from_frame,
783 ETHERNET_INPUT_VARIANT_ETHERNET_TYPE);
784}
Ed Warnickecb9cada2015-12-08 15:45:58 -0700785
786static uword
787ethernet_input_not_l2 (vlib_main_t * vm,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700788 vlib_node_runtime_t * node, vlib_frame_t * from_frame)
789{
790 return ethernet_input_inline (vm, node, from_frame,
791 ETHERNET_INPUT_VARIANT_NOT_L2);
792}
Ed Warnickecb9cada2015-12-08 15:45:58 -0700793
794
795// Return the subinterface config struct for the given sw_if_index
796// Also return via parameter the appropriate match flags for the
797// configured number of tags.
798// On error (unsupported or not ethernet) return 0.
799static subint_config_t *
800ethernet_sw_interface_get_config (vnet_main_t * vnm,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700801 u32 sw_if_index,
802 u32 * flags, u32 * unsupported)
803{
804 ethernet_main_t *em = &ethernet_main;
805 vnet_hw_interface_t *hi;
806 vnet_sw_interface_t *si;
807 main_intf_t *main_intf;
808 vlan_table_t *vlan_table;
809 qinq_table_t *qinq_table;
810 subint_config_t *subint = 0;
811
Ed Warnickecb9cada2015-12-08 15:45:58 -0700812 hi = vnet_get_sup_hw_interface (vnm, sw_if_index);
813
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700814 if (!hi || (hi->hw_class_index != ethernet_hw_interface_class.index))
815 {
816 *unsupported = 0;
817 goto done; // non-ethernet interface
818 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700819
820 // ensure there's an entry for the main intf (shouldn't really be necessary)
821 vec_validate (em->main_intfs, hi->hw_if_index);
822 main_intf = vec_elt_at_index (em->main_intfs, hi->hw_if_index);
823
824 // Locate the subint for the given ethernet config
825 si = vnet_get_sw_interface (vnm, sw_if_index);
826
Pavel Kotucek15ac81c2017-06-20 14:00:26 +0200827 if (si->type == VNET_SW_INTERFACE_TYPE_P2P)
828 {
829 p2p_ethernet_main_t *p2pm = &p2p_main;
830 u32 p2pe_sw_if_index =
831 p2p_ethernet_lookup (hi->hw_if_index, si->p2p.client_mac);
832 if (p2pe_sw_if_index == ~0)
833 {
834 pool_get (p2pm->p2p_subif_pool, subint);
835 si->p2p.pool_index = subint - p2pm->p2p_subif_pool;
836 }
837 else
838 subint = vec_elt_at_index (p2pm->p2p_subif_pool, si->p2p.pool_index);
839 *flags = SUBINT_CONFIG_P2P;
840 }
841 else if (si->sub.eth.flags.default_sub)
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700842 {
843 subint = &main_intf->default_subint;
844 *flags = SUBINT_CONFIG_MATCH_0_TAG |
845 SUBINT_CONFIG_MATCH_1_TAG |
846 SUBINT_CONFIG_MATCH_2_TAG | SUBINT_CONFIG_MATCH_3_TAG;
847 }
848 else if ((si->sub.eth.flags.no_tags) || (si->sub.eth.raw_flags == 0))
849 {
850 // if no flags are set then this is a main interface
851 // so treat as untagged
852 subint = &main_intf->untagged_subint;
853 *flags = SUBINT_CONFIG_MATCH_0_TAG;
854 }
855 else
856 {
857 // one or two tags
858 // first get the vlan table
859 if (si->sub.eth.flags.dot1ad)
860 {
861 if (main_intf->dot1ad_vlans == 0)
862 {
863 // Allocate a vlan table from the pool
864 pool_get (em->vlan_pool, vlan_table);
865 main_intf->dot1ad_vlans = vlan_table - em->vlan_pool;
866 }
867 else
868 {
869 // Get ptr to existing vlan table
870 vlan_table =
871 vec_elt_at_index (em->vlan_pool, main_intf->dot1ad_vlans);
872 }
873 }
874 else
875 { // dot1q
876 if (main_intf->dot1q_vlans == 0)
877 {
878 // Allocate a vlan table from the pool
879 pool_get (em->vlan_pool, vlan_table);
880 main_intf->dot1q_vlans = vlan_table - em->vlan_pool;
881 }
882 else
883 {
884 // Get ptr to existing vlan table
885 vlan_table =
886 vec_elt_at_index (em->vlan_pool, main_intf->dot1q_vlans);
887 }
888 }
889
890 if (si->sub.eth.flags.one_tag)
891 {
892 *flags = si->sub.eth.flags.exact_match ?
893 SUBINT_CONFIG_MATCH_1_TAG :
894 (SUBINT_CONFIG_MATCH_1_TAG |
895 SUBINT_CONFIG_MATCH_2_TAG | SUBINT_CONFIG_MATCH_3_TAG);
896
897 if (si->sub.eth.flags.outer_vlan_id_any)
898 {
899 // not implemented yet
900 *unsupported = 1;
901 goto done;
902 }
903 else
904 {
905 // a single vlan, a common case
906 subint =
907 &vlan_table->vlans[si->sub.eth.
908 outer_vlan_id].single_tag_subint;
909 }
910
911 }
912 else
913 {
914 // Two tags
915 *flags = si->sub.eth.flags.exact_match ?
916 SUBINT_CONFIG_MATCH_2_TAG :
917 (SUBINT_CONFIG_MATCH_2_TAG | SUBINT_CONFIG_MATCH_3_TAG);
918
919 if (si->sub.eth.flags.outer_vlan_id_any
920 && si->sub.eth.flags.inner_vlan_id_any)
921 {
922 // not implemented yet
923 *unsupported = 1;
924 goto done;
925 }
926
927 if (si->sub.eth.flags.inner_vlan_id_any)
928 {
929 // a specific outer and "any" inner
930 // don't need a qinq table for this
931 subint =
932 &vlan_table->vlans[si->sub.eth.
933 outer_vlan_id].inner_any_subint;
934 if (si->sub.eth.flags.exact_match)
935 {
936 *flags = SUBINT_CONFIG_MATCH_2_TAG;
937 }
938 else
939 {
940 *flags = SUBINT_CONFIG_MATCH_2_TAG |
941 SUBINT_CONFIG_MATCH_3_TAG;
942 }
943 }
944 else
945 {
946 // a specific outer + specifc innner vlan id, a common case
947
948 // get the qinq table
949 if (vlan_table->vlans[si->sub.eth.outer_vlan_id].qinqs == 0)
950 {
951 // Allocate a qinq table from the pool
952 pool_get (em->qinq_pool, qinq_table);
953 vlan_table->vlans[si->sub.eth.outer_vlan_id].qinqs =
954 qinq_table - em->qinq_pool;
955 }
956 else
957 {
958 // Get ptr to existing qinq table
959 qinq_table =
960 vec_elt_at_index (em->qinq_pool,
961 vlan_table->vlans[si->sub.
962 eth.outer_vlan_id].
963 qinqs);
964 }
965 subint = &qinq_table->vlans[si->sub.eth.inner_vlan_id].subint;
966 }
967 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700968 }
969
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700970done:
Ed Warnickecb9cada2015-12-08 15:45:58 -0700971 return subint;
972}
973
974clib_error_t *
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700975ethernet_sw_interface_up_down (vnet_main_t * vnm, u32 sw_if_index, u32 flags)
Ed Warnickecb9cada2015-12-08 15:45:58 -0700976{
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700977 subint_config_t *subint;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700978 u32 dummy_flags;
979 u32 dummy_unsup;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700980 clib_error_t *error = 0;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700981
982 // Find the config for this subinterface
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700983 subint =
984 ethernet_sw_interface_get_config (vnm, sw_if_index, &dummy_flags,
985 &dummy_unsup);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700986
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700987 if (subint == 0)
988 {
989 // not implemented yet or not ethernet
990 goto done;
991 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700992
993 subint->sw_if_index =
994 ((flags & VNET_SW_INTERFACE_FLAG_ADMIN_UP) ? sw_if_index : ~0);
995
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -0700996done:
Ed Warnickecb9cada2015-12-08 15:45:58 -0700997 return error;
998}
999
1000VNET_SW_INTERFACE_ADMIN_UP_DOWN_FUNCTION (ethernet_sw_interface_up_down);
1001
1002
1003// Set the L2/L3 mode for the subinterface
1004void
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001005ethernet_sw_interface_set_l2_mode (vnet_main_t * vnm, u32 sw_if_index, u32 l2)
Ed Warnickecb9cada2015-12-08 15:45:58 -07001006{
1007 subint_config_t *subint;
1008 u32 dummy_flags;
1009 u32 dummy_unsup;
1010 int is_port;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001011 vnet_sw_interface_t *sw = vnet_get_sw_interface (vnm, sw_if_index);
Ed Warnickecb9cada2015-12-08 15:45:58 -07001012
1013 is_port = !(sw->type == VNET_SW_INTERFACE_TYPE_SUB);
1014
1015 // Find the config for this subinterface
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001016 subint =
1017 ethernet_sw_interface_get_config (vnm, sw_if_index, &dummy_flags,
1018 &dummy_unsup);
Ed Warnickecb9cada2015-12-08 15:45:58 -07001019
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001020 if (subint == 0)
1021 {
1022 // unimplemented or not ethernet
1023 goto done;
1024 }
Ed Warnickecb9cada2015-12-08 15:45:58 -07001025
1026 // Double check that the config we found is for our interface (or the interface is down)
1027 ASSERT ((subint->sw_if_index == sw_if_index) | (subint->sw_if_index == ~0));
1028
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001029 if (l2)
1030 {
1031 subint->flags |= SUBINT_CONFIG_L2;
1032 if (is_port)
1033 subint->flags |=
1034 SUBINT_CONFIG_MATCH_0_TAG | SUBINT_CONFIG_MATCH_1_TAG
1035 | SUBINT_CONFIG_MATCH_2_TAG | SUBINT_CONFIG_MATCH_3_TAG;
1036 }
1037 else
1038 {
1039 subint->flags &= ~SUBINT_CONFIG_L2;
1040 if (is_port)
1041 subint->flags &=
1042 ~(SUBINT_CONFIG_MATCH_1_TAG | SUBINT_CONFIG_MATCH_2_TAG
1043 | SUBINT_CONFIG_MATCH_3_TAG);
1044 }
Ed Warnickecb9cada2015-12-08 15:45:58 -07001045
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001046done:
Ed Warnickecb9cada2015-12-08 15:45:58 -07001047 return;
1048}
1049
Christian Dechamplain (cdechamp)07aecbb2016-04-05 10:40:38 -04001050/*
1051 * Set the L2/L3 mode for the subinterface regardless of port
1052 */
1053void
1054ethernet_sw_interface_set_l2_mode_noport (vnet_main_t * vnm,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001055 u32 sw_if_index, u32 l2)
Christian Dechamplain (cdechamp)07aecbb2016-04-05 10:40:38 -04001056{
1057 subint_config_t *subint;
1058 u32 dummy_flags;
1059 u32 dummy_unsup;
1060
1061 /* Find the config for this subinterface */
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001062 subint =
1063 ethernet_sw_interface_get_config (vnm, sw_if_index, &dummy_flags,
1064 &dummy_unsup);
Christian Dechamplain (cdechamp)07aecbb2016-04-05 10:40:38 -04001065
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001066 if (subint == 0)
1067 {
1068 /* unimplemented or not ethernet */
1069 goto done;
1070 }
Christian Dechamplain (cdechamp)07aecbb2016-04-05 10:40:38 -04001071
1072 /*
1073 * Double check that the config we found is for our interface (or the
1074 * interface is down)
1075 */
1076 ASSERT ((subint->sw_if_index == sw_if_index) | (subint->sw_if_index == ~0));
1077
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001078 if (l2)
1079 {
1080 subint->flags |= SUBINT_CONFIG_L2;
1081 }
1082 else
1083 {
1084 subint->flags &= ~SUBINT_CONFIG_L2;
1085 }
Christian Dechamplain (cdechamp)07aecbb2016-04-05 10:40:38 -04001086
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001087done:
Christian Dechamplain (cdechamp)07aecbb2016-04-05 10:40:38 -04001088 return;
1089}
Ed Warnickecb9cada2015-12-08 15:45:58 -07001090
1091static clib_error_t *
1092ethernet_sw_interface_add_del (vnet_main_t * vnm,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001093 u32 sw_if_index, u32 is_create)
Ed Warnickecb9cada2015-12-08 15:45:58 -07001094{
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001095 clib_error_t *error = 0;
Ed Warnickecb9cada2015-12-08 15:45:58 -07001096 subint_config_t *subint;
1097 u32 match_flags;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001098 u32 unsupported = 0;
Ed Warnickecb9cada2015-12-08 15:45:58 -07001099
1100 // Find the config for this subinterface
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001101 subint =
1102 ethernet_sw_interface_get_config (vnm, sw_if_index, &match_flags,
1103 &unsupported);
Ed Warnickecb9cada2015-12-08 15:45:58 -07001104
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001105 if (subint == 0)
1106 {
1107 // not implemented yet or not ethernet
1108 if (unsupported)
1109 {
Damjan Marion607de1a2016-08-16 22:53:54 +02001110 // this is the NYI case
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001111 error = clib_error_return (0, "not implemented yet");
1112 }
1113 goto done;
Ed Warnickecb9cada2015-12-08 15:45:58 -07001114 }
Ed Warnickecb9cada2015-12-08 15:45:58 -07001115
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001116 if (!is_create)
1117 {
1118 subint->flags = 0;
1119 return error;
1120 }
Ed Warnickecb9cada2015-12-08 15:45:58 -07001121
1122 // Initialize the subint
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001123 if (subint->flags & SUBINT_CONFIG_VALID)
1124 {
1125 // Error vlan already in use
1126 error = clib_error_return (0, "vlan is already in use");
1127 }
1128 else
1129 {
1130 // Note that config is L3 by defaulty
1131 subint->flags = SUBINT_CONFIG_VALID | match_flags;
1132 subint->sw_if_index = ~0; // because interfaces are initially down
1133 }
Ed Warnickecb9cada2015-12-08 15:45:58 -07001134
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001135done:
Ed Warnickecb9cada2015-12-08 15:45:58 -07001136 return error;
1137}
1138
1139VNET_SW_INTERFACE_ADD_DEL_FUNCTION (ethernet_sw_interface_add_del);
1140
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001141static char *ethernet_error_strings[] = {
Ed Warnickecb9cada2015-12-08 15:45:58 -07001142#define ethernet_error(n,c,s) s,
1143#include "error.def"
1144#undef ethernet_error
1145};
1146
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001147/* *INDENT-OFF* */
Ed Warnickecb9cada2015-12-08 15:45:58 -07001148VLIB_REGISTER_NODE (ethernet_input_node) = {
1149 .function = ethernet_input,
1150 .name = "ethernet-input",
1151 /* Takes a vector of packets. */
1152 .vector_size = sizeof (u32),
Ed Warnickecb9cada2015-12-08 15:45:58 -07001153 .n_errors = ETHERNET_N_ERROR,
1154 .error_strings = ethernet_error_strings,
Ed Warnickecb9cada2015-12-08 15:45:58 -07001155 .n_next_nodes = ETHERNET_INPUT_N_NEXT,
1156 .next_nodes = {
1157#define _(s,n) [ETHERNET_INPUT_NEXT_##s] = n,
1158 foreach_ethernet_input_next
1159#undef _
1160 },
Ed Warnickecb9cada2015-12-08 15:45:58 -07001161 .format_buffer = format_ethernet_header_with_length,
1162 .format_trace = format_ethernet_input_trace,
1163 .unformat_buffer = unformat_ethernet_header,
1164};
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001165/* *INDENT-ON* */
Ed Warnickecb9cada2015-12-08 15:45:58 -07001166
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001167/* *INDENT-OFF* */
Damjan Marion1c80e832016-05-11 23:07:18 +02001168VLIB_NODE_FUNCTION_MULTIARCH (ethernet_input_node, ethernet_input)
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001169/* *INDENT-ON* */
Damjan Marion1c80e832016-05-11 23:07:18 +02001170
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001171/* *INDENT-OFF* */
1172VLIB_REGISTER_NODE (ethernet_input_type_node, static) = {
Ed Warnickecb9cada2015-12-08 15:45:58 -07001173 .function = ethernet_input_type,
1174 .name = "ethernet-input-type",
1175 /* Takes a vector of packets. */
1176 .vector_size = sizeof (u32),
Ed Warnickecb9cada2015-12-08 15:45:58 -07001177 .n_next_nodes = ETHERNET_INPUT_N_NEXT,
1178 .next_nodes = {
1179#define _(s,n) [ETHERNET_INPUT_NEXT_##s] = n,
1180 foreach_ethernet_input_next
1181#undef _
1182 },
1183};
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001184/* *INDENT-ON* */
Ed Warnickecb9cada2015-12-08 15:45:58 -07001185
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001186/* *INDENT-OFF* */
Damjan Marion1c80e832016-05-11 23:07:18 +02001187VLIB_NODE_FUNCTION_MULTIARCH (ethernet_input_type_node, ethernet_input_type)
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001188/* *INDENT-ON* */
Damjan Marion1c80e832016-05-11 23:07:18 +02001189
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001190/* *INDENT-OFF* */
1191VLIB_REGISTER_NODE (ethernet_input_not_l2_node, static) = {
Ed Warnickecb9cada2015-12-08 15:45:58 -07001192 .function = ethernet_input_not_l2,
1193 .name = "ethernet-input-not-l2",
1194 /* Takes a vector of packets. */
1195 .vector_size = sizeof (u32),
Ed Warnickecb9cada2015-12-08 15:45:58 -07001196 .n_next_nodes = ETHERNET_INPUT_N_NEXT,
1197 .next_nodes = {
1198#define _(s,n) [ETHERNET_INPUT_NEXT_##s] = n,
1199 foreach_ethernet_input_next
1200#undef _
1201 },
1202};
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001203/* *INDENT-ON* */
Ed Warnickecb9cada2015-12-08 15:45:58 -07001204
Damjan Marion1c80e832016-05-11 23:07:18 +02001205
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001206/* *INDENT-OFF* */
1207VLIB_NODE_FUNCTION_MULTIARCH (ethernet_input_not_l2_node,
1208 ethernet_input_not_l2)
1209/* *INDENT-ON* */
1210
1211
1212void
1213ethernet_set_rx_redirect (vnet_main_t * vnm,
1214 vnet_hw_interface_t * hi, u32 enable)
Ed Warnickecb9cada2015-12-08 15:45:58 -07001215{
1216 // Insure all packets go to ethernet-input (i.e. untagged ipv4 packets
1217 // don't go directly to ip4-input)
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001218 vnet_hw_interface_rx_redirect_to_node
1219 (vnm, hi->hw_if_index, enable ? ethernet_input_node.index : ~0);
Ed Warnickecb9cada2015-12-08 15:45:58 -07001220}
1221
1222
1223/*
1224 * Initialization and registration for the next_by_ethernet structure
1225 */
1226
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001227clib_error_t *
1228next_by_ethertype_init (next_by_ethertype_t * l3_next)
Ed Warnickecb9cada2015-12-08 15:45:58 -07001229{
1230 l3_next->input_next_by_type = sparse_vec_new
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001231 ( /* elt bytes */ sizeof (l3_next->input_next_by_type[0]),
Ed Warnickecb9cada2015-12-08 15:45:58 -07001232 /* bits in index */ BITS (((ethernet_header_t *) 0)->type));
1233
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001234 vec_validate (l3_next->sparse_index_by_input_next_index,
1235 ETHERNET_INPUT_NEXT_DROP);
1236 vec_validate (l3_next->sparse_index_by_input_next_index,
1237 ETHERNET_INPUT_NEXT_PUNT);
1238 l3_next->sparse_index_by_input_next_index[ETHERNET_INPUT_NEXT_DROP] =
1239 SPARSE_VEC_INVALID_INDEX;
1240 l3_next->sparse_index_by_input_next_index[ETHERNET_INPUT_NEXT_PUNT] =
1241 SPARSE_VEC_INVALID_INDEX;
1242
Damjan Marion607de1a2016-08-16 22:53:54 +02001243 /*
1244 * Make sure we don't wipe out an ethernet registration by mistake
Dave Barach1f49ed62016-02-24 11:29:06 -05001245 * Can happen if init function ordering constraints are missing.
1246 */
1247 if (CLIB_DEBUG > 0)
1248 {
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001249 ethernet_main_t *em = &ethernet_main;
1250 ASSERT (em->next_by_ethertype_register_called == 0);
Dave Barach1f49ed62016-02-24 11:29:06 -05001251 }
1252
Ed Warnickecb9cada2015-12-08 15:45:58 -07001253 return 0;
1254}
1255
1256// Add an ethertype -> next index mapping to the structure
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001257clib_error_t *
1258next_by_ethertype_register (next_by_ethertype_t * l3_next,
1259 u32 ethertype, u32 next_index)
Ed Warnickecb9cada2015-12-08 15:45:58 -07001260{
1261 u32 i;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001262 u16 *n;
1263 ethernet_main_t *em = &ethernet_main;
Ed Warnickecb9cada2015-12-08 15:45:58 -07001264
Dave Barach1f49ed62016-02-24 11:29:06 -05001265 if (CLIB_DEBUG > 0)
1266 {
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001267 ethernet_main_t *em = &ethernet_main;
Dave Barach1f49ed62016-02-24 11:29:06 -05001268 em->next_by_ethertype_register_called = 1;
1269 }
1270
Ed Warnickecb9cada2015-12-08 15:45:58 -07001271 /* Setup ethernet type -> next index sparse vector mapping. */
1272 n = sparse_vec_validate (l3_next->input_next_by_type, ethertype);
1273 n[0] = next_index;
1274
1275 /* Rebuild next index -> sparse index inverse mapping when sparse vector
1276 is updated. */
1277 vec_validate (l3_next->sparse_index_by_input_next_index, next_index);
1278 for (i = 1; i < vec_len (l3_next->input_next_by_type); i++)
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001279 l3_next->
1280 sparse_index_by_input_next_index[l3_next->input_next_by_type[i]] = i;
Ed Warnickecb9cada2015-12-08 15:45:58 -07001281
1282 // do not allow the cached next index's to be updated if L3
1283 // redirect is enabled, as it will have overwritten them
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001284 if (!em->redirect_l3)
1285 {
1286 // Cache common ethertypes directly
1287 if (ethertype == ETHERNET_TYPE_IP4)
1288 {
1289 l3_next->input_next_ip4 = next_index;
1290 }
1291 else if (ethertype == ETHERNET_TYPE_IP6)
1292 {
1293 l3_next->input_next_ip6 = next_index;
1294 }
Neale Ranns0f26c5a2017-03-01 15:12:11 -08001295 else if (ethertype == ETHERNET_TYPE_MPLS)
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001296 {
1297 l3_next->input_next_mpls = next_index;
1298 }
Ed Warnickecb9cada2015-12-08 15:45:58 -07001299 }
Ed Warnickecb9cada2015-12-08 15:45:58 -07001300 return 0;
1301}
1302
1303
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001304static clib_error_t *
1305ethernet_input_init (vlib_main_t * vm)
Ed Warnickecb9cada2015-12-08 15:45:58 -07001306{
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001307 ethernet_main_t *em = &ethernet_main;
1308 __attribute__ ((unused)) vlan_table_t *invalid_vlan_table;
1309 __attribute__ ((unused)) qinq_table_t *invalid_qinq_table;
Ed Warnickecb9cada2015-12-08 15:45:58 -07001310
1311 ethernet_setup_node (vm, ethernet_input_node.index);
1312 ethernet_setup_node (vm, ethernet_input_type_node.index);
1313 ethernet_setup_node (vm, ethernet_input_not_l2_node.index);
1314
1315 next_by_ethertype_init (&em->l3_next);
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001316
Ed Warnickecb9cada2015-12-08 15:45:58 -07001317 // Initialize pools and vector for vlan parsing
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001318 vec_validate (em->main_intfs, 10); // 10 main interfaces
1319 pool_alloc (em->vlan_pool, 10);
1320 pool_alloc (em->qinq_pool, 1);
Ed Warnickecb9cada2015-12-08 15:45:58 -07001321
1322 // The first vlan pool will always be reserved for an invalid table
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001323 pool_get (em->vlan_pool, invalid_vlan_table); // first id = 0
Ed Warnickecb9cada2015-12-08 15:45:58 -07001324 // The first qinq pool will always be reserved for an invalid table
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001325 pool_get (em->qinq_pool, invalid_qinq_table); // first id = 0
Ed Warnickecb9cada2015-12-08 15:45:58 -07001326
1327 return 0;
1328}
1329
1330VLIB_INIT_FUNCTION (ethernet_input_init);
1331
1332void
1333ethernet_register_input_type (vlib_main_t * vm,
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001334 ethernet_type_t type, u32 node_index)
Ed Warnickecb9cada2015-12-08 15:45:58 -07001335{
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001336 ethernet_main_t *em = &ethernet_main;
1337 ethernet_type_info_t *ti;
Ed Warnickecb9cada2015-12-08 15:45:58 -07001338 u32 i;
1339
1340 {
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001341 clib_error_t *error = vlib_call_init_function (vm, ethernet_init);
Ed Warnickecb9cada2015-12-08 15:45:58 -07001342 if (error)
1343 clib_error_report (error);
1344 }
1345
1346 ti = ethernet_get_type_info (em, type);
1347 ti->node_index = node_index;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001348 ti->next_index = vlib_node_add_next (vm,
1349 ethernet_input_node.index, node_index);
1350 i = vlib_node_add_next (vm, ethernet_input_type_node.index, node_index);
Ed Warnickecb9cada2015-12-08 15:45:58 -07001351 ASSERT (i == ti->next_index);
1352
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001353 i = vlib_node_add_next (vm, ethernet_input_not_l2_node.index, node_index);
Ed Warnickecb9cada2015-12-08 15:45:58 -07001354 ASSERT (i == ti->next_index);
1355
1356 // Add the L3 node for this ethertype to the next nodes structure
1357 next_by_ethertype_register (&em->l3_next, type, ti->next_index);
1358
1359 // Call the registration functions for other nodes that want a mapping
1360 l2bvi_register_input_type (vm, type, node_index);
1361}
1362
1363void
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001364ethernet_register_l2_input (vlib_main_t * vm, u32 node_index)
Ed Warnickecb9cada2015-12-08 15:45:58 -07001365{
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001366 ethernet_main_t *em = &ethernet_main;
Ed Warnickecb9cada2015-12-08 15:45:58 -07001367 u32 i;
1368
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001369 em->l2_next =
1370 vlib_node_add_next (vm, ethernet_input_node.index, node_index);
Ed Warnickecb9cada2015-12-08 15:45:58 -07001371
Damjan Marion607de1a2016-08-16 22:53:54 +02001372 /*
Ed Warnickecb9cada2015-12-08 15:45:58 -07001373 * Even if we never use these arcs, we have to align the next indices...
1374 */
1375 i = vlib_node_add_next (vm, ethernet_input_type_node.index, node_index);
1376
1377 ASSERT (i == em->l2_next);
1378
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001379 i = vlib_node_add_next (vm, ethernet_input_not_l2_node.index, node_index);
Ed Warnickecb9cada2015-12-08 15:45:58 -07001380 ASSERT (i == em->l2_next);
1381}
1382
1383// Register a next node for L3 redirect, and enable L3 redirect
1384void
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001385ethernet_register_l3_redirect (vlib_main_t * vm, u32 node_index)
Ed Warnickecb9cada2015-12-08 15:45:58 -07001386{
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001387 ethernet_main_t *em = &ethernet_main;
Ed Warnickecb9cada2015-12-08 15:45:58 -07001388 u32 i;
1389
1390 em->redirect_l3 = 1;
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001391 em->redirect_l3_next = vlib_node_add_next (vm,
1392 ethernet_input_node.index,
1393 node_index);
Ed Warnickecb9cada2015-12-08 15:45:58 -07001394 /*
1395 * Change the cached next nodes to the redirect node
1396 */
1397 em->l3_next.input_next_ip4 = em->redirect_l3_next;
1398 em->l3_next.input_next_ip6 = em->redirect_l3_next;
1399 em->l3_next.input_next_mpls = em->redirect_l3_next;
1400
1401 /*
1402 * Even if we never use these arcs, we have to align the next indices...
1403 */
1404 i = vlib_node_add_next (vm, ethernet_input_type_node.index, node_index);
1405
1406 ASSERT (i == em->redirect_l3_next);
jerryianff82ed62016-12-05 17:13:00 +08001407
1408 i = vlib_node_add_next (vm, ethernet_input_not_l2_node.index, node_index);
1409
1410 ASSERT (i == em->redirect_l3_next);
Ed Warnickecb9cada2015-12-08 15:45:58 -07001411}
Keith Burns (alagalah)e70dcc82016-08-15 18:33:19 -07001412
1413/*
1414 * fd.io coding-style-patch-verification: ON
1415 *
1416 * Local Variables:
1417 * eval: (c-set-style "gnu")
1418 * End:
1419 */