blob: 5fa0c8563be4bd6878a67e3eea8bd2daf8eec043 [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 */
Damjan Marione936bbe2016-02-25 23:17:38 +010015
16#include <stdint.h>
17
Ed Warnickecb9cada2015-12-08 15:45:58 -070018#include <vlib/vlib.h>
19#include <vnet/vnet.h>
20#include <vnet/policer/policer.h>
Neale Rannsd91c1db2017-07-31 02:30:50 -070021#include <vnet/policer/police_inlines.h>
Matus Fabian4ac74c92016-05-31 07:33:29 -070022#include <vnet/ip/ip.h>
Matus Fabian70e6a8d2016-06-20 08:10:42 -070023#include <vnet/classify/policer_classify.h>
24#include <vnet/classify/vnet_classify.h>
Neale Ranns3b81a1e2018-09-06 09:50:26 -070025#include <vnet/l2/feat_bitmap.h>
26#include <vnet/l2/l2_input.h>
Matus Fabian4ac74c92016-05-31 07:33:29 -070027
Ed Warnickecb9cada2015-12-08 15:45:58 -070028
29/* Dispatch functions meant to be instantiated elsewhere */
30
Damjan Marion3891cd82016-10-27 10:27:00 +020031typedef struct
32{
Ed Warnickecb9cada2015-12-08 15:45:58 -070033 u32 next_index;
34 u32 sw_if_index;
35 u32 policer_index;
36} vnet_policer_trace_t;
37
38/* packet trace format function */
Damjan Marion3891cd82016-10-27 10:27:00 +020039static u8 *
40format_policer_trace (u8 * s, va_list * args)
Ed Warnickecb9cada2015-12-08 15:45:58 -070041{
42 CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
43 CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
Damjan Marion3891cd82016-10-27 10:27:00 +020044 vnet_policer_trace_t *t = va_arg (*args, vnet_policer_trace_t *);
45
Ed Warnickecb9cada2015-12-08 15:45:58 -070046 s = format (s, "VNET_POLICER: sw_if_index %d policer_index %d next %d",
Damjan Marion3891cd82016-10-27 10:27:00 +020047 t->sw_if_index, t->policer_index, t->next_index);
Ed Warnickecb9cada2015-12-08 15:45:58 -070048 return s;
49}
50
51#define foreach_vnet_policer_error \
52_(TRANSMIT, "Packets Transmitted") \
53_(DROP, "Packets Dropped")
54
Damjan Marion3891cd82016-10-27 10:27:00 +020055typedef enum
56{
Ed Warnickecb9cada2015-12-08 15:45:58 -070057#define _(sym,str) VNET_POLICER_ERROR_##sym,
58 foreach_vnet_policer_error
59#undef _
Damjan Marion3891cd82016-10-27 10:27:00 +020060 VNET_POLICER_N_ERROR,
Ed Warnickecb9cada2015-12-08 15:45:58 -070061} vnet_policer_error_t;
62
Damjan Marion3891cd82016-10-27 10:27:00 +020063static char *vnet_policer_error_strings[] = {
Ed Warnickecb9cada2015-12-08 15:45:58 -070064#define _(sym,string) string,
65 foreach_vnet_policer_error
66#undef _
67};
68
Damjan Marion3891cd82016-10-27 10:27:00 +020069static inline uword
Brian Russell15c18e32021-02-17 15:45:56 +000070vnet_policer_inline (vlib_main_t *vm, vlib_node_runtime_t *node,
Stanislav Zaikine5a3ae02022-04-05 19:23:12 +020071 vlib_frame_t *frame, vlib_dir_t dir)
Ed Warnickecb9cada2015-12-08 15:45:58 -070072{
Damjan Marion3891cd82016-10-27 10:27:00 +020073 u32 n_left_from, *from, *to_next;
Ed Warnickecb9cada2015-12-08 15:45:58 -070074 vnet_policer_next_t next_index;
Damjan Marion3891cd82016-10-27 10:27:00 +020075 vnet_policer_main_t *pm = &vnet_policer_main;
Ed Warnickecb9cada2015-12-08 15:45:58 -070076 u64 time_in_policer_periods;
77 u32 transmitted = 0;
78
Damjan Marion3891cd82016-10-27 10:27:00 +020079 time_in_policer_periods =
80 clib_cpu_time_now () >> POLICER_TICKS_PER_PERIOD_SHIFT;
Ed Warnickecb9cada2015-12-08 15:45:58 -070081
82 from = vlib_frame_vector_args (frame);
83 n_left_from = frame->n_vectors;
84 next_index = node->cached_next_index;
85
86 while (n_left_from > 0)
87 {
88 u32 n_left_to_next;
89
Damjan Marion3891cd82016-10-27 10:27:00 +020090 vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
Ed Warnickecb9cada2015-12-08 15:45:58 -070091
92 while (n_left_from >= 4 && n_left_to_next >= 2)
93 {
Damjan Marion3891cd82016-10-27 10:27:00 +020094 u32 bi0, bi1;
95 vlib_buffer_t *b0, *b1;
96 u32 next0, next1;
97 u32 sw_if_index0, sw_if_index1;
98 u32 pi0 = 0, pi1 = 0;
99 u8 act0, act1;
100
Ed Warnickecb9cada2015-12-08 15:45:58 -0700101 /* Prefetch next iteration. */
102 {
Damjan Marion3891cd82016-10-27 10:27:00 +0200103 vlib_buffer_t *b2, *b3;
104
Ed Warnickecb9cada2015-12-08 15:45:58 -0700105 b2 = vlib_get_buffer (vm, from[2]);
106 b3 = vlib_get_buffer (vm, from[3]);
Damjan Marion3891cd82016-10-27 10:27:00 +0200107
Ed Warnickecb9cada2015-12-08 15:45:58 -0700108 vlib_prefetch_buffer_header (b2, LOAD);
109 vlib_prefetch_buffer_header (b3, LOAD);
110 }
111
Damjan Marion3891cd82016-10-27 10:27:00 +0200112 /* speculatively enqueue b0 and b1 to the current next frame */
Ed Warnickecb9cada2015-12-08 15:45:58 -0700113 to_next[0] = bi0 = from[0];
114 to_next[1] = bi1 = from[1];
115 from += 2;
116 to_next += 2;
117 n_left_from -= 2;
118 n_left_to_next -= 2;
119
120 b0 = vlib_get_buffer (vm, bi0);
121 b1 = vlib_get_buffer (vm, bi1);
122
Stanislav Zaikine5a3ae02022-04-05 19:23:12 +0200123 sw_if_index0 = vnet_buffer (b0)->sw_if_index[dir];
124 sw_if_index1 = vnet_buffer (b1)->sw_if_index[dir];
Ed Warnickecb9cada2015-12-08 15:45:58 -0700125
Stanislav Zaikine5a3ae02022-04-05 19:23:12 +0200126 pi0 = pm->policer_index_by_sw_if_index[dir][sw_if_index0];
127 pi1 = pm->policer_index_by_sw_if_index[dir][sw_if_index1];
Ed Warnickecb9cada2015-12-08 15:45:58 -0700128
Damjan Marion3891cd82016-10-27 10:27:00 +0200129 act0 = vnet_policer_police (vm, b0, pi0, time_in_policer_periods,
Brian Russell1aa99122021-02-18 11:00:38 +0000130 POLICE_CONFORM /* no chaining */, true);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700131
Damjan Marion3891cd82016-10-27 10:27:00 +0200132 act1 = vnet_policer_police (vm, b1, pi1, time_in_policer_periods,
Brian Russell1aa99122021-02-18 11:00:38 +0000133 POLICE_CONFORM /* no chaining */, true);
Matus Fabian4ac74c92016-05-31 07:33:29 -0700134
Brian Russell1aa99122021-02-18 11:00:38 +0000135 if (PREDICT_FALSE (act0 == QOS_ACTION_HANDOFF))
136 {
137 next0 = VNET_POLICER_NEXT_HANDOFF;
138 vnet_buffer (b0)->policer.index = pi0;
139 }
140 else if (PREDICT_FALSE (act0 == QOS_ACTION_DROP))
Damjan Marion3891cd82016-10-27 10:27:00 +0200141 {
142 next0 = VNET_POLICER_NEXT_DROP;
143 b0->error = node->errors[VNET_POLICER_ERROR_DROP];
144 }
Brian Russell1aa99122021-02-18 11:00:38 +0000145 else /* transmit or mark-and-transmit action */
Damjan Marion3891cd82016-10-27 10:27:00 +0200146 {
147 transmitted++;
Brian Russell15c18e32021-02-17 15:45:56 +0000148 vnet_feature_next (&next0, b0);
Damjan Marion3891cd82016-10-27 10:27:00 +0200149 }
Matus Fabian4ac74c92016-05-31 07:33:29 -0700150
Brian Russell1aa99122021-02-18 11:00:38 +0000151 if (PREDICT_FALSE (act1 == QOS_ACTION_HANDOFF))
152 {
153 next1 = VNET_POLICER_NEXT_HANDOFF;
154 vnet_buffer (b1)->policer.index = pi1;
155 }
156 else if (PREDICT_FALSE (act1 == QOS_ACTION_DROP)) /* drop action */
Damjan Marion3891cd82016-10-27 10:27:00 +0200157 {
158 next1 = VNET_POLICER_NEXT_DROP;
159 b1->error = node->errors[VNET_POLICER_ERROR_DROP];
160 }
Brian Russell1aa99122021-02-18 11:00:38 +0000161 else /* transmit or mark-and-transmit action */
Damjan Marion3891cd82016-10-27 10:27:00 +0200162 {
163 transmitted++;
Brian Russell15c18e32021-02-17 15:45:56 +0000164 vnet_feature_next (&next1, b1);
Damjan Marion3891cd82016-10-27 10:27:00 +0200165 }
Ed Warnickecb9cada2015-12-08 15:45:58 -0700166
Damjan Marion3891cd82016-10-27 10:27:00 +0200167 if (PREDICT_FALSE ((node->flags & VLIB_NODE_FLAG_TRACE)))
168 {
169 if (b0->flags & VLIB_BUFFER_IS_TRACED)
170 {
171 vnet_policer_trace_t *t =
172 vlib_add_trace (vm, node, b0, sizeof (*t));
173 t->sw_if_index = sw_if_index0;
174 t->next_index = next0;
175 }
176 if (b1->flags & VLIB_BUFFER_IS_TRACED)
177 {
178 vnet_policer_trace_t *t =
179 vlib_add_trace (vm, node, b1, sizeof (*t));
180 t->sw_if_index = sw_if_index1;
181 t->next_index = next1;
182 }
183 }
184
185 /* verify speculative enqueues, maybe switch current next frame */
186 vlib_validate_buffer_enqueue_x2 (vm, node, next_index,
187 to_next, n_left_to_next,
188 bi0, bi1, next0, next1);
189 }
190
Ed Warnickecb9cada2015-12-08 15:45:58 -0700191 while (n_left_from > 0 && n_left_to_next > 0)
192 {
Damjan Marion3891cd82016-10-27 10:27:00 +0200193 u32 bi0;
194 vlib_buffer_t *b0;
195 u32 next0;
196 u32 sw_if_index0;
197 u32 pi0 = 0;
198 u8 act0;
Ed Warnickecb9cada2015-12-08 15:45:58 -0700199
200 bi0 = from[0];
201 to_next[0] = bi0;
202 from += 1;
203 to_next += 1;
204 n_left_from -= 1;
205 n_left_to_next -= 1;
206
207 b0 = vlib_get_buffer (vm, bi0);
208
Stanislav Zaikine5a3ae02022-04-05 19:23:12 +0200209 sw_if_index0 = vnet_buffer (b0)->sw_if_index[dir];
210 pi0 = pm->policer_index_by_sw_if_index[dir][sw_if_index0];
Ed Warnickecb9cada2015-12-08 15:45:58 -0700211
Damjan Marion3891cd82016-10-27 10:27:00 +0200212 act0 = vnet_policer_police (vm, b0, pi0, time_in_policer_periods,
Brian Russell1aa99122021-02-18 11:00:38 +0000213 POLICE_CONFORM /* no chaining */, true);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700214
Brian Russell1aa99122021-02-18 11:00:38 +0000215 if (PREDICT_FALSE (act0 == QOS_ACTION_HANDOFF))
216 {
217 next0 = VNET_POLICER_NEXT_HANDOFF;
218 vnet_buffer (b0)->policer.index = pi0;
219 }
220 else if (PREDICT_FALSE (act0 == QOS_ACTION_DROP))
Damjan Marion3891cd82016-10-27 10:27:00 +0200221 {
222 next0 = VNET_POLICER_NEXT_DROP;
223 b0->error = node->errors[VNET_POLICER_ERROR_DROP];
224 }
Brian Russell1aa99122021-02-18 11:00:38 +0000225 else /* transmit or mark-and-transmit action */
Damjan Marion3891cd82016-10-27 10:27:00 +0200226 {
227 transmitted++;
Brian Russell15c18e32021-02-17 15:45:56 +0000228 vnet_feature_next (&next0, b0);
Damjan Marion3891cd82016-10-27 10:27:00 +0200229 }
230
231 if (PREDICT_FALSE ((node->flags & VLIB_NODE_FLAG_TRACE)
232 && (b0->flags & VLIB_BUFFER_IS_TRACED)))
233 {
234 vnet_policer_trace_t *t =
235 vlib_add_trace (vm, node, b0, sizeof (*t));
236 t->sw_if_index = sw_if_index0;
237 t->next_index = next0;
238 t->policer_index = pi0;
239 }
240
241 /* verify speculative enqueue, maybe switch current next frame */
Ed Warnickecb9cada2015-12-08 15:45:58 -0700242 vlib_validate_buffer_enqueue_x1 (vm, node, next_index,
243 to_next, n_left_to_next,
244 bi0, next0);
245 }
246
247 vlib_put_next_frame (vm, node, next_index, n_left_to_next);
248 }
249
Damjan Marion3891cd82016-10-27 10:27:00 +0200250 vlib_node_increment_counter (vm, node->node_index,
251 VNET_POLICER_ERROR_TRANSMIT, transmitted);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700252 return frame->n_vectors;
253}
254
Brian Russell15c18e32021-02-17 15:45:56 +0000255VLIB_NODE_FN (policer_input_node)
256(vlib_main_t *vm, vlib_node_runtime_t *node, vlib_frame_t *frame)
Ed Warnickecb9cada2015-12-08 15:45:58 -0700257{
Stanislav Zaikine5a3ae02022-04-05 19:23:12 +0200258 return vnet_policer_inline (vm, node, frame, VLIB_RX);
Ed Warnickecb9cada2015-12-08 15:45:58 -0700259}
260
Brian Russell15c18e32021-02-17 15:45:56 +0000261VLIB_REGISTER_NODE (policer_input_node) = {
262 .name = "policer-input",
Ed Warnickecb9cada2015-12-08 15:45:58 -0700263 .vector_size = sizeof (u32),
264 .format_trace = format_policer_trace,
265 .type = VLIB_NODE_TYPE_INTERNAL,
Ed Warnickecb9cada2015-12-08 15:45:58 -0700266 .n_errors = ARRAY_LEN(vnet_policer_error_strings),
267 .error_strings = vnet_policer_error_strings,
Ed Warnickecb9cada2015-12-08 15:45:58 -0700268 .n_next_nodes = VNET_POLICER_N_NEXT,
Ed Warnickecb9cada2015-12-08 15:45:58 -0700269 .next_nodes = {
Brian Russell15c18e32021-02-17 15:45:56 +0000270 [VNET_POLICER_NEXT_DROP] = "error-drop",
Brian Russell1aa99122021-02-18 11:00:38 +0000271 [VNET_POLICER_NEXT_HANDOFF] = "policer-input-handoff",
Brian Russell15c18e32021-02-17 15:45:56 +0000272 },
Ed Warnickecb9cada2015-12-08 15:45:58 -0700273};
Damjan Marion1c80e832016-05-11 23:07:18 +0200274
Brian Russell15c18e32021-02-17 15:45:56 +0000275VNET_FEATURE_INIT (policer_input_node, static) = {
276 .arc_name = "device-input",
277 .node_name = "policer-input",
278 .runs_before = VNET_FEATURES ("ethernet-input"),
Ed Warnickecb9cada2015-12-08 15:45:58 -0700279};
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700280
Stanislav Zaikine5a3ae02022-04-05 19:23:12 +0200281VLIB_NODE_FN (policer_output_node)
282(vlib_main_t *vm, vlib_node_runtime_t *node, vlib_frame_t *frame)
283{
284 return vnet_policer_inline (vm, node, frame, VLIB_TX);
285}
286
287VLIB_REGISTER_NODE (policer_output_node) = {
288 .name = "policer-output",
289 .vector_size = sizeof (u32),
290 .format_trace = format_policer_trace,
291 .type = VLIB_NODE_TYPE_INTERNAL,
292 .n_errors = ARRAY_LEN(vnet_policer_error_strings),
293 .error_strings = vnet_policer_error_strings,
294 .n_next_nodes = VNET_POLICER_N_NEXT,
295 .next_nodes = {
296 [VNET_POLICER_NEXT_DROP] = "error-drop",
297 [VNET_POLICER_NEXT_HANDOFF] = "policer-output-handoff",
298 },
299};
300
301VNET_FEATURE_INIT (policer_output_node, static) = {
302 .arc_name = "ip4-output",
303 .node_name = "policer-output",
304};
305
306VNET_FEATURE_INIT (policer6_output_node, static) = {
307 .arc_name = "ip6-output",
308 .node_name = "policer-output",
309};
310
Brian Russell1aa99122021-02-18 11:00:38 +0000311static char *policer_input_handoff_error_strings[] = { "congestion drop" };
312
313VLIB_NODE_FN (policer_input_handoff_node)
314(vlib_main_t *vm, vlib_node_runtime_t *node, vlib_frame_t *frame)
315{
Stanislav Zaikine5a3ae02022-04-05 19:23:12 +0200316 return policer_handoff (vm, node, frame, vnet_policer_main.fq_index[VLIB_RX],
317 ~0);
Brian Russell1aa99122021-02-18 11:00:38 +0000318}
319
320VLIB_REGISTER_NODE (policer_input_handoff_node) = {
321 .name = "policer-input-handoff",
322 .vector_size = sizeof (u32),
323 .format_trace = format_policer_handoff_trace,
324 .type = VLIB_NODE_TYPE_INTERNAL,
325 .n_errors = ARRAY_LEN(policer_input_handoff_error_strings),
326 .error_strings = policer_input_handoff_error_strings,
327
328 .n_next_nodes = 1,
329 .next_nodes = {
330 [0] = "error-drop",
331 },
332};
333
Stanislav Zaikine5a3ae02022-04-05 19:23:12 +0200334VLIB_NODE_FN (policer_output_handoff_node)
335(vlib_main_t *vm, vlib_node_runtime_t *node, vlib_frame_t *frame)
336{
337 return policer_handoff (vm, node, frame, vnet_policer_main.fq_index[VLIB_TX],
338 ~0);
339}
340
341VLIB_REGISTER_NODE (policer_output_handoff_node) = {
342 .name = "policer-output-handoff",
343 .vector_size = sizeof (u32),
344 .format_trace = format_policer_handoff_trace,
345 .type = VLIB_NODE_TYPE_INTERNAL,
346 .n_errors = ARRAY_LEN(policer_input_handoff_error_strings),
347 .error_strings = policer_input_handoff_error_strings,
348
349 .n_next_nodes = 1,
350 .next_nodes = {
351 [0] = "error-drop",
352 },
353};
Damjan Marion3891cd82016-10-27 10:27:00 +0200354typedef struct
355{
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700356 u32 sw_if_index;
357 u32 next_index;
358 u32 table_index;
359 u32 offset;
360 u32 policer_index;
361} policer_classify_trace_t;
362
363static u8 *
364format_policer_classify_trace (u8 * s, va_list * args)
365{
366 CLIB_UNUSED (vlib_main_t * vm) = va_arg (*args, vlib_main_t *);
367 CLIB_UNUSED (vlib_node_t * node) = va_arg (*args, vlib_node_t *);
Damjan Marion3891cd82016-10-27 10:27:00 +0200368 policer_classify_trace_t *t = va_arg (*args, policer_classify_trace_t *);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700369
370 s = format (s, "POLICER_CLASSIFY: sw_if_index %d next %d table %d offset %d"
Damjan Marion3891cd82016-10-27 10:27:00 +0200371 " policer_index %d",
372 t->sw_if_index, t->next_index, t->table_index, t->offset,
373 t->policer_index);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700374 return s;
375}
376
377#define foreach_policer_classify_error \
378_(MISS, "Policer classify misses") \
379_(HIT, "Policer classify hits") \
Paul Vinciguerrabdc0e6b2018-09-22 05:32:50 -0700380_(CHAIN_HIT, "Policer classify hits after chain walk") \
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700381_(DROP, "Policer classify action drop")
382
Damjan Marion3891cd82016-10-27 10:27:00 +0200383typedef enum
384{
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700385#define _(sym,str) POLICER_CLASSIFY_ERROR_##sym,
386 foreach_policer_classify_error
387#undef _
Damjan Marion3891cd82016-10-27 10:27:00 +0200388 POLICER_CLASSIFY_N_ERROR,
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700389} policer_classify_error_t;
390
Damjan Marion3891cd82016-10-27 10:27:00 +0200391static char *policer_classify_error_strings[] = {
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700392#define _(sym,string) string,
393 foreach_policer_classify_error
394#undef _
395};
396
397static inline uword
398policer_classify_inline (vlib_main_t * vm,
Damjan Marion3891cd82016-10-27 10:27:00 +0200399 vlib_node_runtime_t * node,
400 vlib_frame_t * frame,
401 policer_classify_table_id_t tid)
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700402{
Damjan Marion3891cd82016-10-27 10:27:00 +0200403 u32 n_left_from, *from, *to_next;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700404 policer_classify_next_index_t next_index;
Damjan Marion3891cd82016-10-27 10:27:00 +0200405 policer_classify_main_t *pcm = &policer_classify_main;
406 vnet_classify_main_t *vcm = pcm->vnet_classify_main;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700407 f64 now = vlib_time_now (vm);
408 u32 hits = 0;
409 u32 misses = 0;
410 u32 chain_hits = 0;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700411 u32 n_next_nodes;
412 u64 time_in_policer_periods;
413
414 time_in_policer_periods =
Damjan Marion3891cd82016-10-27 10:27:00 +0200415 clib_cpu_time_now () >> POLICER_TICKS_PER_PERIOD_SHIFT;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700416
417 n_next_nodes = node->n_next_nodes;
418
419 from = vlib_frame_vector_args (frame);
420 n_left_from = frame->n_vectors;
421
422 /* First pass: compute hashes */
423 while (n_left_from > 2)
424 {
Damjan Marion3891cd82016-10-27 10:27:00 +0200425 vlib_buffer_t *b0, *b1;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700426 u32 bi0, bi1;
Damjan Marion3891cd82016-10-27 10:27:00 +0200427 u8 *h0, *h1;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700428 u32 sw_if_index0, sw_if_index1;
429 u32 table_index0, table_index1;
Damjan Marion3891cd82016-10-27 10:27:00 +0200430 vnet_classify_table_t *t0, *t1;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700431
432 /* Prefetch next iteration */
433 {
Damjan Marion3891cd82016-10-27 10:27:00 +0200434 vlib_buffer_t *p1, *p2;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700435
Damjan Marion3891cd82016-10-27 10:27:00 +0200436 p1 = vlib_get_buffer (vm, from[1]);
437 p2 = vlib_get_buffer (vm, from[2]);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700438
Damjan Marion3891cd82016-10-27 10:27:00 +0200439 vlib_prefetch_buffer_header (p1, STORE);
Damjan Marionaf7fb042021-07-15 11:54:41 +0200440 clib_prefetch_store (p1->data);
Damjan Marion3891cd82016-10-27 10:27:00 +0200441 vlib_prefetch_buffer_header (p2, STORE);
Damjan Marionaf7fb042021-07-15 11:54:41 +0200442 clib_prefetch_store (p2->data);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700443 }
444
445 bi0 = from[0];
446 b0 = vlib_get_buffer (vm, bi0);
447 h0 = b0->data;
448
449 bi1 = from[1];
450 b1 = vlib_get_buffer (vm, bi1);
451 h1 = b1->data;
452
453 sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
Damjan Marion3891cd82016-10-27 10:27:00 +0200454 table_index0 =
455 pcm->classify_table_index_by_sw_if_index[tid][sw_if_index0];
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700456
457 sw_if_index1 = vnet_buffer (b1)->sw_if_index[VLIB_RX];
Damjan Marion3891cd82016-10-27 10:27:00 +0200458 table_index1 =
459 pcm->classify_table_index_by_sw_if_index[tid][sw_if_index1];
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700460
461 t0 = pool_elt_at_index (vcm->tables, table_index0);
462
463 t1 = pool_elt_at_index (vcm->tables, table_index1);
464
Damjan Marion3891cd82016-10-27 10:27:00 +0200465 vnet_buffer (b0)->l2_classify.hash =
466 vnet_classify_hash_packet (t0, (u8 *) h0);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700467
Damjan Marion3891cd82016-10-27 10:27:00 +0200468 vnet_classify_prefetch_bucket (t0, vnet_buffer (b0)->l2_classify.hash);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700469
Damjan Marion3891cd82016-10-27 10:27:00 +0200470 vnet_buffer (b1)->l2_classify.hash =
471 vnet_classify_hash_packet (t1, (u8 *) h1);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700472
Damjan Marion3891cd82016-10-27 10:27:00 +0200473 vnet_classify_prefetch_bucket (t1, vnet_buffer (b1)->l2_classify.hash);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700474
Damjan Marion3891cd82016-10-27 10:27:00 +0200475 vnet_buffer (b0)->l2_classify.table_index = table_index0;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700476
Damjan Marion3891cd82016-10-27 10:27:00 +0200477 vnet_buffer (b1)->l2_classify.table_index = table_index1;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700478
479 from += 2;
480 n_left_from -= 2;
481 }
482
483 while (n_left_from > 0)
484 {
Damjan Marion3891cd82016-10-27 10:27:00 +0200485 vlib_buffer_t *b0;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700486 u32 bi0;
Damjan Marion3891cd82016-10-27 10:27:00 +0200487 u8 *h0;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700488 u32 sw_if_index0;
489 u32 table_index0;
Damjan Marion3891cd82016-10-27 10:27:00 +0200490 vnet_classify_table_t *t0;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700491
492 bi0 = from[0];
493 b0 = vlib_get_buffer (vm, bi0);
494 h0 = b0->data;
495
496 sw_if_index0 = vnet_buffer (b0)->sw_if_index[VLIB_RX];
Damjan Marion3891cd82016-10-27 10:27:00 +0200497 table_index0 =
498 pcm->classify_table_index_by_sw_if_index[tid][sw_if_index0];
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700499
500 t0 = pool_elt_at_index (vcm->tables, table_index0);
Damjan Marion3891cd82016-10-27 10:27:00 +0200501 vnet_buffer (b0)->l2_classify.hash =
502 vnet_classify_hash_packet (t0, (u8 *) h0);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700503
Damjan Marion3891cd82016-10-27 10:27:00 +0200504 vnet_buffer (b0)->l2_classify.table_index = table_index0;
505 vnet_classify_prefetch_bucket (t0, vnet_buffer (b0)->l2_classify.hash);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700506
507 from++;
508 n_left_from--;
509 }
510
511 next_index = node->cached_next_index;
512 from = vlib_frame_vector_args (frame);
513 n_left_from = frame->n_vectors;
514
515 while (n_left_from > 0)
516 {
517 u32 n_left_to_next;
518
519 vlib_get_next_frame (vm, node, next_index, to_next, n_left_to_next);
520
521 /* Not enough load/store slots to dual loop... */
522 while (n_left_from > 0 && n_left_to_next > 0)
Damjan Marion3891cd82016-10-27 10:27:00 +0200523 {
524 u32 bi0;
525 vlib_buffer_t *b0;
526 u32 next0 = POLICER_CLASSIFY_NEXT_INDEX_DROP;
527 u32 table_index0;
528 vnet_classify_table_t *t0;
529 vnet_classify_entry_t *e0;
530 u64 hash0;
531 u8 *h0;
532 u8 act0;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700533
Damjan Marion3891cd82016-10-27 10:27:00 +0200534 /* Stride 3 seems to work best */
535 if (PREDICT_TRUE (n_left_from > 3))
536 {
537 vlib_buffer_t *p1 = vlib_get_buffer (vm, from[3]);
538 vnet_classify_table_t *tp1;
539 u32 table_index1;
540 u64 phash1;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700541
Damjan Marion3891cd82016-10-27 10:27:00 +0200542 table_index1 = vnet_buffer (p1)->l2_classify.table_index;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700543
Damjan Marion3891cd82016-10-27 10:27:00 +0200544 if (PREDICT_TRUE (table_index1 != ~0))
545 {
546 tp1 = pool_elt_at_index (vcm->tables, table_index1);
547 phash1 = vnet_buffer (p1)->l2_classify.hash;
548 vnet_classify_prefetch_entry (tp1, phash1);
549 }
550 }
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700551
Damjan Marion3891cd82016-10-27 10:27:00 +0200552 /* Speculatively enqueue b0 to the current next frame */
553 bi0 = from[0];
554 to_next[0] = bi0;
555 from += 1;
556 to_next += 1;
557 n_left_from -= 1;
558 n_left_to_next -= 1;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700559
Damjan Marion3891cd82016-10-27 10:27:00 +0200560 b0 = vlib_get_buffer (vm, bi0);
561 h0 = b0->data;
562 table_index0 = vnet_buffer (b0)->l2_classify.table_index;
563 e0 = 0;
564 t0 = 0;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700565
Damjan Marion3891cd82016-10-27 10:27:00 +0200566 if (tid == POLICER_CLASSIFY_TABLE_L2)
567 {
John Lobeb0b2e2017-07-22 00:21:36 -0400568 /* Feature bitmap update and determine the next node */
569 next0 = vnet_l2_feature_next (b0, pcm->feat_next_node_index,
570 L2INPUT_FEAT_POLICER_CLAS);
Damjan Marion3891cd82016-10-27 10:27:00 +0200571 }
572 else
573 vnet_get_config_data (pcm->vnet_config_main[tid],
574 &b0->current_config_index, &next0,
575 /* # bytes of config data */ 0);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700576
Damjan Marion3891cd82016-10-27 10:27:00 +0200577 vnet_buffer (b0)->l2_classify.opaque_index = ~0;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700578
Damjan Marion3891cd82016-10-27 10:27:00 +0200579 if (PREDICT_TRUE (table_index0 != ~0))
580 {
581 hash0 = vnet_buffer (b0)->l2_classify.hash;
582 t0 = pool_elt_at_index (vcm->tables, table_index0);
583 e0 = vnet_classify_find_entry (t0, (u8 *) h0, hash0, now);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700584
Damjan Marion3891cd82016-10-27 10:27:00 +0200585 if (e0)
586 {
Brian Russellfce88652021-02-18 10:25:23 +0000587 act0 = vnet_policer_police (vm, b0, e0->next_index,
Damjan Marion3891cd82016-10-27 10:27:00 +0200588 time_in_policer_periods,
Brian Russellfce88652021-02-18 10:25:23 +0000589 e0->opaque_index, false);
Brian Russellc5299ff2021-02-09 10:16:58 +0000590 if (PREDICT_FALSE (act0 == QOS_ACTION_DROP))
Damjan Marion3891cd82016-10-27 10:27:00 +0200591 {
592 next0 = POLICER_CLASSIFY_NEXT_INDEX_DROP;
593 b0->error = node->errors[POLICER_CLASSIFY_ERROR_DROP];
Damjan Marion3891cd82016-10-27 10:27:00 +0200594 }
595 hits++;
596 }
597 else
598 {
599 while (1)
600 {
601 if (PREDICT_TRUE (t0->next_table_index != ~0))
602 {
603 t0 = pool_elt_at_index (vcm->tables,
604 t0->next_table_index);
605 }
606 else
607 {
608 next0 = (t0->miss_next_index < n_next_nodes) ?
609 t0->miss_next_index : next0;
610 misses++;
611 break;
612 }
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700613
Damjan Marion3891cd82016-10-27 10:27:00 +0200614 hash0 = vnet_classify_hash_packet (t0, (u8 *) h0);
615 e0 =
616 vnet_classify_find_entry (t0, (u8 *) h0, hash0, now);
617 if (e0)
618 {
Brian Russellfce88652021-02-18 10:25:23 +0000619 act0 = vnet_policer_police (vm, b0, e0->next_index,
Damjan Marion3891cd82016-10-27 10:27:00 +0200620 time_in_policer_periods,
Brian Russellfce88652021-02-18 10:25:23 +0000621 e0->opaque_index, false);
Brian Russellc5299ff2021-02-09 10:16:58 +0000622 if (PREDICT_FALSE (act0 == QOS_ACTION_DROP))
Damjan Marion3891cd82016-10-27 10:27:00 +0200623 {
624 next0 = POLICER_CLASSIFY_NEXT_INDEX_DROP;
625 b0->error =
626 node->errors[POLICER_CLASSIFY_ERROR_DROP];
Damjan Marion3891cd82016-10-27 10:27:00 +0200627 }
628 hits++;
629 chain_hits++;
630 break;
631 }
632 }
633 }
634 }
635 if (PREDICT_FALSE ((node->flags & VLIB_NODE_FLAG_TRACE)
636 && (b0->flags & VLIB_BUFFER_IS_TRACED)))
637 {
638 policer_classify_trace_t *t =
639 vlib_add_trace (vm, node, b0, sizeof (*t));
640 t->sw_if_index = vnet_buffer (b0)->sw_if_index[VLIB_RX];
641 t->next_index = next0;
642 t->table_index = t0 ? t0 - vcm->tables : ~0;
643 t->offset = (e0 && t0) ? vnet_classify_get_offset (t0, e0) : ~0;
644 t->policer_index = e0 ? e0->next_index : ~0;
645 }
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700646
Damjan Marion3891cd82016-10-27 10:27:00 +0200647 /* Verify speculative enqueue, maybe switch current next frame */
648 vlib_validate_buffer_enqueue_x1 (vm, node, next_index, to_next,
649 n_left_to_next, bi0, next0);
650 }
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700651
652 vlib_put_next_frame (vm, node, next_index, n_left_to_next);
653 }
654
655 vlib_node_increment_counter (vm, node->node_index,
Damjan Marion3891cd82016-10-27 10:27:00 +0200656 POLICER_CLASSIFY_ERROR_MISS, misses);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700657 vlib_node_increment_counter (vm, node->node_index,
Damjan Marion3891cd82016-10-27 10:27:00 +0200658 POLICER_CLASSIFY_ERROR_HIT, hits);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700659 vlib_node_increment_counter (vm, node->node_index,
Damjan Marion3891cd82016-10-27 10:27:00 +0200660 POLICER_CLASSIFY_ERROR_CHAIN_HIT, chain_hits);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700661
662 return frame->n_vectors;
663}
664
Filip Tehlar30d93482019-03-06 04:28:32 -0800665VLIB_NODE_FN (ip4_policer_classify_node) (vlib_main_t * vm,
666 vlib_node_runtime_t * node,
667 vlib_frame_t * frame)
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700668{
Damjan Marion3891cd82016-10-27 10:27:00 +0200669 return policer_classify_inline (vm, node, frame,
670 POLICER_CLASSIFY_TABLE_IP4);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700671}
672
Damjan Marion3891cd82016-10-27 10:27:00 +0200673/* *INDENT-OFF* */
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700674VLIB_REGISTER_NODE (ip4_policer_classify_node) = {
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700675 .name = "ip4-policer-classify",
676 .vector_size = sizeof (u32),
677 .format_trace = format_policer_classify_trace,
678 .n_errors = ARRAY_LEN(policer_classify_error_strings),
679 .error_strings = policer_classify_error_strings,
680 .n_next_nodes = POLICER_CLASSIFY_NEXT_INDEX_N_NEXT,
681 .next_nodes = {
682 [POLICER_CLASSIFY_NEXT_INDEX_DROP] = "error-drop",
683 },
684};
Damjan Marion3891cd82016-10-27 10:27:00 +0200685/* *INDENT-ON* */
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700686
Filip Tehlar30d93482019-03-06 04:28:32 -0800687VLIB_NODE_FN (ip6_policer_classify_node) (vlib_main_t * vm,
688 vlib_node_runtime_t * node,
689 vlib_frame_t * frame)
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700690{
Damjan Marion3891cd82016-10-27 10:27:00 +0200691 return policer_classify_inline (vm, node, frame,
692 POLICER_CLASSIFY_TABLE_IP6);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700693}
694
Damjan Marion3891cd82016-10-27 10:27:00 +0200695/* *INDENT-OFF* */
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700696VLIB_REGISTER_NODE (ip6_policer_classify_node) = {
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700697 .name = "ip6-policer-classify",
698 .vector_size = sizeof (u32),
699 .format_trace = format_policer_classify_trace,
700 .n_errors = ARRAY_LEN(policer_classify_error_strings),
701 .error_strings = policer_classify_error_strings,
702 .n_next_nodes = POLICER_CLASSIFY_NEXT_INDEX_N_NEXT,
703 .next_nodes = {
704 [POLICER_CLASSIFY_NEXT_INDEX_DROP] = "error-drop",
705 },
706};
Damjan Marion3891cd82016-10-27 10:27:00 +0200707/* *INDENT-ON* */
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700708
Filip Tehlar30d93482019-03-06 04:28:32 -0800709VLIB_NODE_FN (l2_policer_classify_node) (vlib_main_t * vm,
710 vlib_node_runtime_t * node,
711 vlib_frame_t * frame)
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700712{
Damjan Marion3891cd82016-10-27 10:27:00 +0200713 return policer_classify_inline (vm, node, frame, POLICER_CLASSIFY_TABLE_L2);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700714}
715
Krishanpal singhd2fec4a2017-11-27 19:40:56 +0530716/* *INDENT-OFF* */
717VLIB_REGISTER_NODE (l2_policer_classify_node) = {
Krishanpal singhd2fec4a2017-11-27 19:40:56 +0530718 .name = "l2-policer-classify",
719 .vector_size = sizeof (u32),
720 .format_trace = format_policer_classify_trace,
721 .n_errors = ARRAY_LEN (policer_classify_error_strings),
722 .error_strings = policer_classify_error_strings,
723 .n_next_nodes = POLICER_CLASSIFY_NEXT_INDEX_N_NEXT,
724 .next_nodes = {
725 [POLICER_CLASSIFY_NEXT_INDEX_DROP] = "error-drop",
726 },
727};
Krishanpal singhd2fec4a2017-11-27 19:40:56 +0530728/* *INDENT-ON* */
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700729
Filip Tehlar30d93482019-03-06 04:28:32 -0800730#ifndef CLIB_MARCH_VARIANT
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700731static clib_error_t *
Damjan Marion3891cd82016-10-27 10:27:00 +0200732policer_classify_init (vlib_main_t * vm)
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700733{
Damjan Marion3891cd82016-10-27 10:27:00 +0200734 policer_classify_main_t *pcm = &policer_classify_main;
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700735
736 pcm->vlib_main = vm;
Damjan Marion3891cd82016-10-27 10:27:00 +0200737 pcm->vnet_main = vnet_get_main ();
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700738 pcm->vnet_classify_main = &vnet_classify_main;
739
740 /* Initialize L2 feature next-node indexes */
Damjan Marion3891cd82016-10-27 10:27:00 +0200741 feat_bitmap_init_next_nodes (vm,
742 l2_policer_classify_node.index,
743 L2INPUT_N_FEAT,
744 l2input_get_feat_names (),
745 pcm->feat_next_node_index);
Matus Fabian70e6a8d2016-06-20 08:10:42 -0700746
747 return 0;
748}
749
750VLIB_INIT_FUNCTION (policer_classify_init);
Filip Tehlar30d93482019-03-06 04:28:32 -0800751#endif /* CLIB_MARCH_VARIANT */
Damjan Marion3891cd82016-10-27 10:27:00 +0200752
753/*
754 * fd.io coding-style-patch-verification: ON
755 *
756 * Local Variables:
757 * eval: (c-set-style "gnu")
758 * End:
759 */