2 * Copyright (c) 2018 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.
17 * @brief NAT44 worker handoff
20 #include <vlib/vlib.h>
21 #include <vnet/vnet.h>
22 #include <vnet/fib/ip4_fib.h>
23 #include <vppinfra/error.h>
25 #include <nat/nat44-ed/nat44_ed.h>
26 #include <nat/nat44-ed/nat44_ed_inlines.h>
30 u32 next_worker_index;
34 } nat44_handoff_trace_t;
36 #define foreach_nat44_handoff_error \
37 _ (CONGESTION_DROP, "congestion drop") \
38 _ (SAME_WORKER, "same worker") \
39 _ (DO_HANDOFF, "do handoff")
43 #define _(sym, str) NAT44_HANDOFF_ERROR_##sym,
44 foreach_nat44_handoff_error
46 NAT44_HANDOFF_N_ERROR,
47 } nat44_handoff_error_t;
49 static char *nat44_handoff_error_strings[] = {
50 #define _(sym,string) string,
51 foreach_nat44_handoff_error
56 format_nat44_handoff_trace (u8 * s, va_list * args)
58 CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
59 CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
60 nat44_handoff_trace_t *t = va_arg (*args, nat44_handoff_trace_t *);
63 tag = t->in2out ? "IN2OUT" : "OUT2IN";
64 output = t->output ? "OUTPUT-FEATURE" : "";
66 format (s, "NAT44_%s_WORKER_HANDOFF %s: next-worker %d trace index %d",
67 tag, output, t->next_worker_index, t->trace_index);
73 nat44_worker_handoff_fn_inline (vlib_main_t * vm,
74 vlib_node_runtime_t * node,
75 vlib_frame_t * frame, u8 is_output,
78 u32 n_enq, n_left_from, *from, do_handoff = 0, same_worker = 0;
80 u16 thread_indices[VLIB_FRAME_SIZE], *ti = thread_indices;
81 vlib_buffer_t *bufs[VLIB_FRAME_SIZE], **b = bufs;
82 snat_main_t *sm = &snat_main;
84 u32 fq_index, thread_index = vm->thread_index;
86 from = vlib_frame_vector_args (frame);
87 n_left_from = frame->n_vectors;
89 vlib_get_buffers (vm, from, b, n_left_from);
93 fq_index = is_output ? sm->fq_in2out_output_index : sm->fq_in2out_index;
97 fq_index = sm->fq_out2in_index;
100 while (n_left_from >= 4)
102 u32 arc_next0, arc_next1, arc_next2, arc_next3;
103 u32 sw_if_index0, sw_if_index1, sw_if_index2, sw_if_index3;
104 u32 rx_fib_index0, rx_fib_index1, rx_fib_index2, rx_fib_index3;
105 u32 iph_offset0 = 0, iph_offset1 = 0, iph_offset2 = 0, iph_offset3 = 0;
106 ip4_header_t *ip0, *ip1, *ip2, *ip3;
108 if (PREDICT_TRUE (n_left_from >= 8))
110 vlib_prefetch_buffer_header (b[4], LOAD);
111 vlib_prefetch_buffer_header (b[5], LOAD);
112 vlib_prefetch_buffer_header (b[6], LOAD);
113 vlib_prefetch_buffer_header (b[7], LOAD);
114 clib_prefetch_load (&b[4]->data);
115 clib_prefetch_load (&b[5]->data);
116 clib_prefetch_load (&b[6]->data);
117 clib_prefetch_load (&b[7]->data);
122 iph_offset0 = vnet_buffer (b[0])->ip.save_rewrite_length;
123 iph_offset1 = vnet_buffer (b[1])->ip.save_rewrite_length;
124 iph_offset2 = vnet_buffer (b[2])->ip.save_rewrite_length;
125 iph_offset3 = vnet_buffer (b[3])->ip.save_rewrite_length;
128 ip0 = (ip4_header_t *) ((u8 *) vlib_buffer_get_current (b[0]) +
130 ip1 = (ip4_header_t *) ((u8 *) vlib_buffer_get_current (b[1]) +
132 ip2 = (ip4_header_t *) ((u8 *) vlib_buffer_get_current (b[2]) +
134 ip3 = (ip4_header_t *) ((u8 *) vlib_buffer_get_current (b[3]) +
137 vnet_feature_next (&arc_next0, b[0]);
138 vnet_feature_next (&arc_next1, b[1]);
139 vnet_feature_next (&arc_next2, b[2]);
140 vnet_feature_next (&arc_next3, b[3]);
142 vnet_buffer2 (b[0])->nat.arc_next = arc_next0;
143 vnet_buffer2 (b[1])->nat.arc_next = arc_next1;
144 vnet_buffer2 (b[2])->nat.arc_next = arc_next2;
145 vnet_buffer2 (b[3])->nat.arc_next = arc_next3;
147 sw_if_index0 = vnet_buffer (b[0])->sw_if_index[VLIB_RX];
148 sw_if_index1 = vnet_buffer (b[1])->sw_if_index[VLIB_RX];
149 sw_if_index2 = vnet_buffer (b[2])->sw_if_index[VLIB_RX];
150 sw_if_index3 = vnet_buffer (b[3])->sw_if_index[VLIB_RX];
152 rx_fib_index0 = ip4_fib_table_get_index_for_sw_if_index (sw_if_index0);
153 rx_fib_index1 = ip4_fib_table_get_index_for_sw_if_index (sw_if_index1);
154 rx_fib_index2 = ip4_fib_table_get_index_for_sw_if_index (sw_if_index2);
155 rx_fib_index3 = ip4_fib_table_get_index_for_sw_if_index (sw_if_index3);
159 ti[0] = nat44_ed_get_in2out_worker_index (b[0], ip0, rx_fib_index0,
161 ti[1] = nat44_ed_get_in2out_worker_index (b[1], ip1, rx_fib_index1,
163 ti[2] = nat44_ed_get_in2out_worker_index (b[2], ip2, rx_fib_index2,
165 ti[3] = nat44_ed_get_in2out_worker_index (b[3], ip3, rx_fib_index3,
170 ti[0] = nat44_ed_get_out2in_worker_index (b[0], ip0, rx_fib_index0,
172 ti[1] = nat44_ed_get_out2in_worker_index (b[1], ip1, rx_fib_index1,
174 ti[2] = nat44_ed_get_out2in_worker_index (b[2], ip2, rx_fib_index2,
176 ti[3] = nat44_ed_get_out2in_worker_index (b[3], ip3, rx_fib_index3,
180 if (ti[0] == thread_index)
185 if (ti[1] == thread_index)
190 if (ti[2] == thread_index)
195 if (ti[3] == thread_index)
205 while (n_left_from > 0)
215 iph_offset0 = vnet_buffer (b[0])->ip.save_rewrite_length;
217 ip0 = (ip4_header_t *) ((u8 *) vlib_buffer_get_current (b[0]) +
220 vnet_feature_next (&arc_next0, b[0]);
221 vnet_buffer2 (b[0])->nat.arc_next = arc_next0;
223 sw_if_index0 = vnet_buffer (b[0])->sw_if_index[VLIB_RX];
224 rx_fib_index0 = ip4_fib_table_get_index_for_sw_if_index (sw_if_index0);
228 ti[0] = nat44_ed_get_in2out_worker_index (b[0], ip0, rx_fib_index0,
233 ti[0] = nat44_ed_get_out2in_worker_index (b[0], ip0, rx_fib_index0,
237 if (ti[0] == thread_index)
247 if (PREDICT_FALSE ((node->flags & VLIB_NODE_FLAG_TRACE)))
253 for (i = 0; i < frame->n_vectors; i++)
255 if (b[0]->flags & VLIB_BUFFER_IS_TRACED)
257 nat44_handoff_trace_t *t =
258 vlib_add_trace (vm, node, b[0], sizeof (*t));
259 t->next_worker_index = ti[0];
260 t->trace_index = vlib_buffer_get_trace_index (b[0]);
261 t->in2out = is_in2out;
262 t->output = is_output;
272 n_enq = vlib_buffer_enqueue_to_thread (vm, node, fq_index, from,
273 thread_indices, frame->n_vectors, 1);
275 if (n_enq < frame->n_vectors)
277 vlib_node_increment_counter (vm, node->node_index,
278 NAT44_HANDOFF_ERROR_CONGESTION_DROP,
279 frame->n_vectors - n_enq);
282 vlib_node_increment_counter (vm, node->node_index,
283 NAT44_HANDOFF_ERROR_SAME_WORKER, same_worker);
284 vlib_node_increment_counter (vm, node->node_index,
285 NAT44_HANDOFF_ERROR_DO_HANDOFF, do_handoff);
286 return frame->n_vectors;
289 VLIB_NODE_FN (snat_in2out_worker_handoff_node) (vlib_main_t * vm,
290 vlib_node_runtime_t * node,
291 vlib_frame_t * frame)
293 return nat44_worker_handoff_fn_inline (vm, node, frame, 0, 1);
296 VLIB_REGISTER_NODE (snat_in2out_worker_handoff_node) = {
297 .name = "nat44-in2out-worker-handoff",
298 .vector_size = sizeof (u32),
299 .sibling_of = "nat-default",
300 .format_trace = format_nat44_handoff_trace,
301 .type = VLIB_NODE_TYPE_INTERNAL,
302 .n_errors = ARRAY_LEN(nat44_handoff_error_strings),
303 .error_strings = nat44_handoff_error_strings,
306 VLIB_NODE_FN (snat_in2out_output_worker_handoff_node) (vlib_main_t * vm,
307 vlib_node_runtime_t *
309 vlib_frame_t * frame)
311 return nat44_worker_handoff_fn_inline (vm, node, frame, 1, 1);
314 VLIB_REGISTER_NODE (snat_in2out_output_worker_handoff_node) = {
315 .name = "nat44-in2out-output-worker-handoff",
316 .vector_size = sizeof (u32),
317 .sibling_of = "nat-default",
318 .format_trace = format_nat44_handoff_trace,
319 .type = VLIB_NODE_TYPE_INTERNAL,
320 .n_errors = ARRAY_LEN(nat44_handoff_error_strings),
321 .error_strings = nat44_handoff_error_strings,
324 VLIB_NODE_FN (snat_out2in_worker_handoff_node) (vlib_main_t * vm,
325 vlib_node_runtime_t * node,
326 vlib_frame_t * frame)
328 return nat44_worker_handoff_fn_inline (vm, node, frame, 0, 0);
331 VLIB_REGISTER_NODE (snat_out2in_worker_handoff_node) = {
332 .name = "nat44-out2in-worker-handoff",
333 .vector_size = sizeof (u32),
334 .sibling_of = "nat-default",
335 .format_trace = format_nat44_handoff_trace,
336 .type = VLIB_NODE_TYPE_INTERNAL,
337 .n_errors = ARRAY_LEN(nat44_handoff_error_strings),
338 .error_strings = nat44_handoff_error_strings,
342 * fd.io coding-style-patch-verification: ON
345 * eval: (c-set-style "gnu")