2 * node.c: p2p ethernet vpp node
4 * Copyright (c) 2016 Cisco and/or its affiliates.
5 * Licensed under the Apache License, Version 2.0 (the "License");
6 * you may not use this file except in compliance with the License.
7 * You may obtain a copy of the License at:
9 * http://www.apache.org/licenses/LICENSE-2.0
11 * Unless required by applicable law or agreed to in writing, software
12 * distributed under the License is distributed on an "AS IS" BASIS,
13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14 * See the License for the specific language governing permissions and
15 * limitations under the License.
18 #include <vlib/vlib.h>
19 #include <vnet/vnet.h>
20 #include <vppinfra/error.h>
22 #include <vnet/ethernet/p2p_ethernet.h>
24 #include <vppinfra/error.h>
25 #include <vppinfra/elog.h>
27 vlib_node_registration_t p2p_ethernet_input_node;
29 /* packet trace format function */
31 format_p2p_ethernet_trace (u8 * s, va_list * args)
33 CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
34 CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
35 p2p_ethernet_trace_t *t = va_arg (*args, p2p_ethernet_trace_t *);
37 vnet_main_t *vnm = &vnet_main;
38 s = format (s, "P2P ethernet: %U -> %U",
39 format_vnet_sw_if_index_name, vnm, t->sw_if_index,
40 format_vnet_sw_if_index_name, vnm, t->p2pe_sw_if_index);
45 #define foreach_p2p_ethernet_error \
46 _(HITS, "P2P ethernet incoming packets processed")
50 #define _(sym,str) P2PE_ERROR_##sym,
51 foreach_p2p_ethernet_error
54 } p2p_ethernet_error_t;
56 static char *p2p_ethernet_error_strings[] = {
57 #define _(sym,string) string,
58 foreach_p2p_ethernet_error
63 p2p_ethernet_input_node_fn (vlib_main_t * vm,
64 vlib_node_runtime_t * node, vlib_frame_t * frame)
66 u32 n_trace = vlib_get_trace_count (vm, node);
67 u32 n_left_from, *from, *to_next;
69 u32 n_p2p_ethernet_packets = 0;
71 from = vlib_frame_vector_args (frame);
72 n_left_from = frame->n_vectors;
73 next_index = node->cached_next_index;
75 while (n_left_from > 0)
79 vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
81 while (n_left_from >= 4 && n_left_to_next >= 2)
84 vlib_buffer_t *b0, *b1;
85 u32 next0 = 0, next1 = 0;
86 u32 sw_if_index0, sw_if_index1;
87 ethernet_header_t *en0, *en1;
99 b0 = vlib_get_buffer (vm, bi0);
100 b1 = vlib_get_buffer (vm, bi1);
102 en0 = vlib_buffer_get_current (b0);
103 sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
104 en1 = vlib_buffer_get_current (b1);
105 sw_if_index1 = vnet_buffer (b1)->sw_if_index[VLIB_RX];
107 vnet_feature_next (sw_if_index0, &next0, b0);
108 vnet_feature_next (sw_if_index1, &next1, b1);
110 rx0 = p2p_ethernet_lookup (sw_if_index0, en0->src_address);
111 rx1 = p2p_ethernet_lookup (sw_if_index1, en1->src_address);
115 /* Send pkt to p2p_ethernet RX interface */
116 vnet_buffer (b0)->sw_if_index[VLIB_RX] = rx0;
117 n_p2p_ethernet_packets += 1;
119 if (PREDICT_FALSE (n_trace > 0))
121 p2p_ethernet_trace_t *t0;
122 vlib_trace_buffer (vm, node, next_index, b0,
123 1 /* follow_chain */ );
124 vlib_set_trace_count (vm, node, --n_trace);
125 t0 = vlib_add_trace (vm, node, b0, sizeof (*t0));
126 t0->sw_if_index = sw_if_index0;
127 t0->p2pe_sw_if_index = rx0;
132 /* Send pkt to p2p_ethernet RX interface */
133 vnet_buffer (b1)->sw_if_index[VLIB_RX] = rx1;
134 n_p2p_ethernet_packets += 1;
136 if (PREDICT_FALSE (n_trace > 0))
138 p2p_ethernet_trace_t *t1;
139 vlib_trace_buffer (vm, node, next_index, b1,
140 1 /* follow_chain */ );
141 vlib_set_trace_count (vm, node, --n_trace);
142 t1 = vlib_add_trace (vm, node, b1, sizeof (*t1));
143 t1->sw_if_index = sw_if_index1;
144 t1->p2pe_sw_if_index = rx1;
148 /* verify speculative enqueue, maybe switch current next frame */
149 vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
150 to_next, n_left_to_next,
152 vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
153 to_next, n_left_to_next,
157 while (n_left_from > 0 && n_left_to_next > 0)
163 ethernet_header_t *en0;
173 b0 = vlib_get_buffer (vm, bi0);
175 en0 = vlib_buffer_get_current (b0);
176 sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
178 vnet_feature_next (sw_if_index0, &next0, b0);
180 rx0 = p2p_ethernet_lookup (sw_if_index0, en0->src_address);
183 /* Send pkt to p2p_ethernet RX interface */
184 vnet_buffer (b0)->sw_if_index[VLIB_RX] = rx0;
185 n_p2p_ethernet_packets += 1;
187 if (PREDICT_FALSE (n_trace > 0))
189 p2p_ethernet_trace_t *t0;
190 vlib_trace_buffer (vm, node, next_index, b0,
191 1 /* follow_chain */ );
192 vlib_set_trace_count (vm, node, --n_trace);
193 t0 = vlib_add_trace (vm, node, b0, sizeof (*t0));
194 t0->sw_if_index = sw_if_index0;
195 t0->p2pe_sw_if_index = rx0;
200 if (PREDICT_FALSE (n_trace > 0))
202 node->flags |= VLIB_NODE_FLAG_TRACE;
206 /* verify speculative enqueue, maybe switch current next frame */
207 vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
208 to_next, n_left_to_next,
211 vlib_put_next_frame (vm, node, next_index, n_left_to_next);
214 vlib_node_increment_counter (vm, p2p_ethernet_input_node.index,
215 P2PE_ERROR_HITS, n_p2p_ethernet_packets);
216 return frame->n_vectors;
220 VLIB_REGISTER_NODE (p2p_ethernet_input_node) = {
221 .function = p2p_ethernet_input_node_fn,
222 .name = "p2p-ethernet-input",
223 .vector_size = sizeof (u32),
224 .format_trace = format_p2p_ethernet_trace,
225 .type = VLIB_NODE_TYPE_INTERNAL,
227 .n_errors = ARRAY_LEN(p2p_ethernet_error_strings),
228 .error_strings = p2p_ethernet_error_strings,
232 /* edit / add dispositions here */
239 VLIB_NODE_FUNCTION_MULTIARCH (p2p_ethernet_input_node,
240 p2p_ethernet_input_node_fn)
242 * fd.io coding-style-patch-verification: ON
245 * eval: (c-set-style "gnu")