ethdev: make default behavior CRC strip on Rx
[dpdk.git] / examples / qos_meter / main.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2010-2016 Intel Corporation
3  */
4
5 #include <stdio.h>
6 #include <getopt.h>
7
8 #include <rte_common.h>
9 #include <rte_eal.h>
10 #include <rte_malloc.h>
11 #include <rte_mempool.h>
12 #include <rte_ethdev.h>
13 #include <rte_cycles.h>
14 #include <rte_mbuf.h>
15 #include <rte_meter.h>
16
17 /*
18  * Traffic metering configuration
19  *
20  */
21 #define APP_MODE_FWD                    0
22 #define APP_MODE_SRTCM_COLOR_BLIND      1
23 #define APP_MODE_SRTCM_COLOR_AWARE      2
24 #define APP_MODE_TRTCM_COLOR_BLIND      3
25 #define APP_MODE_TRTCM_COLOR_AWARE      4
26
27 #define APP_MODE        APP_MODE_SRTCM_COLOR_BLIND
28
29
30 #include "main.h"
31
32
33 #define APP_PKT_FLOW_POS                33
34 #define APP_PKT_COLOR_POS               5
35
36
37 #if APP_PKT_FLOW_POS > 64 || APP_PKT_COLOR_POS > 64
38 #error Byte offset needs to be less than 64
39 #endif
40
41 /*
42  * Buffer pool configuration
43  *
44  ***/
45 #define NB_MBUF             8192
46 #define MEMPOOL_CACHE_SIZE  256
47
48 static struct rte_mempool *pool = NULL;
49
50 /*
51  * NIC configuration
52  *
53  ***/
54 static struct rte_eth_conf port_conf = {
55         .rxmode = {
56                 .mq_mode        = ETH_MQ_RX_RSS,
57                 .max_rx_pkt_len = ETHER_MAX_LEN,
58                 .split_hdr_size = 0,
59                 .offloads = DEV_RX_OFFLOAD_CHECKSUM,
60         },
61         .rx_adv_conf = {
62                 .rss_conf = {
63                         .rss_key = NULL,
64                         .rss_hf = ETH_RSS_IP,
65                 },
66         },
67         .txmode = {
68                 .mq_mode = ETH_DCB_NONE,
69         },
70 };
71
72 #define NIC_RX_QUEUE_DESC               1024
73 #define NIC_TX_QUEUE_DESC               1024
74
75 #define NIC_RX_QUEUE                    0
76 #define NIC_TX_QUEUE                    0
77
78 /*
79  * Packet RX/TX
80  *
81  ***/
82 #define PKT_RX_BURST_MAX                32
83 #define PKT_TX_BURST_MAX                32
84 #define TIME_TX_DRAIN                   200000ULL
85
86 static uint16_t port_rx;
87 static uint16_t port_tx;
88 static struct rte_mbuf *pkts_rx[PKT_RX_BURST_MAX];
89 struct rte_eth_dev_tx_buffer *tx_buffer;
90
91 struct rte_meter_srtcm_params app_srtcm_params = {
92         .cir = 1000000 * 46,
93         .cbs = 2048,
94         .ebs = 2048
95 };
96
97 struct rte_meter_srtcm_profile app_srtcm_profile;
98
99 struct rte_meter_trtcm_params app_trtcm_params = {
100         .cir = 1000000 * 46,
101         .pir = 1500000 * 46,
102         .cbs = 2048,
103         .pbs = 2048
104 };
105
106 struct rte_meter_trtcm_profile app_trtcm_profile;
107
108 #define APP_FLOWS_MAX  256
109
110 FLOW_METER app_flows[APP_FLOWS_MAX];
111
112 static int
113 app_configure_flow_table(void)
114 {
115         uint32_t i;
116         int ret;
117
118         ret = rte_meter_srtcm_profile_config(&app_srtcm_profile,
119                 &app_srtcm_params);
120         if (ret)
121                 return ret;
122
123         ret = rte_meter_trtcm_profile_config(&app_trtcm_profile,
124                 &app_trtcm_params);
125         if (ret)
126                 return ret;
127
128         for (i = 0; i < APP_FLOWS_MAX; i++) {
129                 ret = FUNC_CONFIG(&app_flows[i], &PROFILE);
130                 if (ret)
131                         return ret;
132         }
133
134         return 0;
135 }
136
137 static inline void
138 app_set_pkt_color(uint8_t *pkt_data, enum policer_action color)
139 {
140         pkt_data[APP_PKT_COLOR_POS] = (uint8_t)color;
141 }
142
143 static inline int
144 app_pkt_handle(struct rte_mbuf *pkt, uint64_t time)
145 {
146         uint8_t input_color, output_color;
147         uint8_t *pkt_data = rte_pktmbuf_mtod(pkt, uint8_t *);
148         uint32_t pkt_len = rte_pktmbuf_pkt_len(pkt) - sizeof(struct ether_hdr);
149         uint8_t flow_id = (uint8_t)(pkt_data[APP_PKT_FLOW_POS] & (APP_FLOWS_MAX - 1));
150         input_color = pkt_data[APP_PKT_COLOR_POS];
151         enum policer_action action;
152
153         /* color input is not used for blind modes */
154         output_color = (uint8_t) FUNC_METER(&app_flows[flow_id],
155                 &PROFILE,
156                 time,
157                 pkt_len,
158                 (enum rte_meter_color) input_color);
159
160         /* Apply policing and set the output color */
161         action = policer_table[input_color][output_color];
162         app_set_pkt_color(pkt_data, action);
163
164         return action;
165 }
166
167
168 static __attribute__((noreturn)) int
169 main_loop(__attribute__((unused)) void *dummy)
170 {
171         uint64_t current_time, last_time = rte_rdtsc();
172         uint32_t lcore_id = rte_lcore_id();
173
174         printf("Core %u: port RX = %d, port TX = %d\n", lcore_id, port_rx, port_tx);
175
176         while (1) {
177                 uint64_t time_diff;
178                 int i, nb_rx;
179
180                 /* Mechanism to avoid stale packets in the output buffer */
181                 current_time = rte_rdtsc();
182                 time_diff = current_time - last_time;
183                 if (unlikely(time_diff > TIME_TX_DRAIN)) {
184                         /* Flush tx buffer */
185                         rte_eth_tx_buffer_flush(port_tx, NIC_TX_QUEUE, tx_buffer);
186                         last_time = current_time;
187                 }
188
189                 /* Read packet burst from NIC RX */
190                 nb_rx = rte_eth_rx_burst(port_rx, NIC_RX_QUEUE, pkts_rx, PKT_RX_BURST_MAX);
191
192                 /* Handle packets */
193                 for (i = 0; i < nb_rx; i ++) {
194                         struct rte_mbuf *pkt = pkts_rx[i];
195
196                         /* Handle current packet */
197                         if (app_pkt_handle(pkt, current_time) == DROP)
198                                 rte_pktmbuf_free(pkt);
199                         else
200                                 rte_eth_tx_buffer(port_tx, NIC_TX_QUEUE, tx_buffer, pkt);
201                 }
202         }
203 }
204
205 static void
206 print_usage(const char *prgname)
207 {
208         printf ("%s [EAL options] -- -p PORTMASK\n"
209                 "  -p PORTMASK: hexadecimal bitmask of ports to configure\n",
210                 prgname);
211 }
212
213 static int
214 parse_portmask(const char *portmask)
215 {
216         char *end = NULL;
217         unsigned long pm;
218
219         /* parse hexadecimal string */
220         pm = strtoul(portmask, &end, 16);
221         if ((portmask[0] == '\0') || (end == NULL) || (*end != '\0'))
222                 return -1;
223
224         if (pm == 0)
225                 return -1;
226
227         return pm;
228 }
229
230 /* Parse the argument given in the command line of the application */
231 static int
232 parse_args(int argc, char **argv)
233 {
234         int opt;
235         char **argvopt;
236         int option_index;
237         char *prgname = argv[0];
238         static struct option lgopts[] = {
239                 {NULL, 0, 0, 0}
240         };
241         uint64_t port_mask, i, mask;
242
243         argvopt = argv;
244
245         while ((opt = getopt_long(argc, argvopt, "p:", lgopts, &option_index)) != EOF) {
246                 switch (opt) {
247                 case 'p':
248                         port_mask = parse_portmask(optarg);
249                         if (port_mask == 0) {
250                                 printf("invalid port mask (null port mask)\n");
251                                 print_usage(prgname);
252                                 return -1;
253                         }
254
255                         for (i = 0, mask = 1; i < 64; i ++, mask <<= 1){
256                                 if (mask & port_mask){
257                                         port_rx = i;
258                                         port_mask &= ~ mask;
259                                         break;
260                                 }
261                         }
262
263                         for (i = 0, mask = 1; i < 64; i ++, mask <<= 1){
264                                 if (mask & port_mask){
265                                         port_tx = i;
266                                         port_mask &= ~ mask;
267                                         break;
268                                 }
269                         }
270
271                         if (port_mask != 0) {
272                                 printf("invalid port mask (more than 2 ports)\n");
273                                 print_usage(prgname);
274                                 return -1;
275                         }
276                         break;
277
278                 default:
279                         print_usage(prgname);
280                         return -1;
281                 }
282         }
283
284         if (optind <= 1) {
285                 print_usage(prgname);
286                 return -1;
287         }
288
289         argv[optind-1] = prgname;
290
291         optind = 1; /* reset getopt lib */
292         return 0;
293 }
294
295 int
296 main(int argc, char **argv)
297 {
298         uint32_t lcore_id;
299         uint16_t nb_rxd = NIC_RX_QUEUE_DESC;
300         uint16_t nb_txd = NIC_TX_QUEUE_DESC;
301         struct rte_eth_conf conf;
302         struct rte_eth_rxconf rxq_conf;
303         struct rte_eth_txconf txq_conf;
304         struct rte_eth_dev_info dev_info;
305         int ret;
306
307         /* EAL init */
308         ret = rte_eal_init(argc, argv);
309         if (ret < 0)
310                 rte_exit(EXIT_FAILURE, "Invalid EAL parameters\n");
311         argc -= ret;
312         argv += ret;
313         if (rte_lcore_count() != 1) {
314                 rte_exit(EXIT_FAILURE, "This application does not accept more than one core. "
315                 "Please adjust the \"-c COREMASK\" parameter accordingly.\n");
316         }
317
318         /* Application non-EAL arguments parse */
319         ret = parse_args(argc, argv);
320         if (ret < 0)
321                 rte_exit(EXIT_FAILURE, "Invalid input arguments\n");
322
323         /* Buffer pool init */
324         pool = rte_pktmbuf_pool_create("pool", NB_MBUF, MEMPOOL_CACHE_SIZE,
325                 0, RTE_MBUF_DEFAULT_BUF_SIZE, rte_socket_id());
326         if (pool == NULL)
327                 rte_exit(EXIT_FAILURE, "Buffer pool creation error\n");
328
329         /* NIC init */
330         conf = port_conf;
331         rte_eth_dev_info_get(port_rx, &dev_info);
332         if (dev_info.tx_offload_capa & DEV_TX_OFFLOAD_MBUF_FAST_FREE)
333                 conf.txmode.offloads |= DEV_TX_OFFLOAD_MBUF_FAST_FREE;
334
335         conf.rx_adv_conf.rss_conf.rss_hf &= dev_info.flow_type_rss_offloads;
336         if (conf.rx_adv_conf.rss_conf.rss_hf !=
337                         port_conf.rx_adv_conf.rss_conf.rss_hf) {
338                 printf("Port %u modified RSS hash function based on hardware support,"
339                         "requested:%#"PRIx64" configured:%#"PRIx64"\n",
340                         port_rx,
341                         port_conf.rx_adv_conf.rss_conf.rss_hf,
342                         conf.rx_adv_conf.rss_conf.rss_hf);
343         }
344
345         ret = rte_eth_dev_configure(port_rx, 1, 1, &conf);
346         if (ret < 0)
347                 rte_exit(EXIT_FAILURE, "Port %d configuration error (%d)\n", port_rx, ret);
348
349         ret = rte_eth_dev_adjust_nb_rx_tx_desc(port_rx, &nb_rxd, &nb_txd);
350         if (ret < 0)
351                 rte_exit(EXIT_FAILURE, "Port %d adjust number of descriptors error (%d)\n",
352                                 port_rx, ret);
353
354         rxq_conf = dev_info.default_rxconf;
355         rxq_conf.offloads = conf.rxmode.offloads;
356         ret = rte_eth_rx_queue_setup(port_rx, NIC_RX_QUEUE, nb_rxd,
357                                 rte_eth_dev_socket_id(port_rx),
358                                 &rxq_conf, pool);
359         if (ret < 0)
360                 rte_exit(EXIT_FAILURE, "Port %d RX queue setup error (%d)\n", port_rx, ret);
361
362         txq_conf = dev_info.default_txconf;
363         txq_conf.offloads = conf.txmode.offloads;
364         ret = rte_eth_tx_queue_setup(port_rx, NIC_TX_QUEUE, nb_txd,
365                                 rte_eth_dev_socket_id(port_rx),
366                                 &txq_conf);
367         if (ret < 0)
368         rte_exit(EXIT_FAILURE, "Port %d TX queue setup error (%d)\n", port_rx, ret);
369
370         conf = port_conf;
371         rte_eth_dev_info_get(port_tx, &dev_info);
372         if (dev_info.tx_offload_capa & DEV_TX_OFFLOAD_MBUF_FAST_FREE)
373                 conf.txmode.offloads |= DEV_TX_OFFLOAD_MBUF_FAST_FREE;
374
375         conf.rx_adv_conf.rss_conf.rss_hf &= dev_info.flow_type_rss_offloads;
376         if (conf.rx_adv_conf.rss_conf.rss_hf !=
377                         port_conf.rx_adv_conf.rss_conf.rss_hf) {
378                 printf("Port %u modified RSS hash function based on hardware support,"
379                         "requested:%#"PRIx64" configured:%#"PRIx64"\n",
380                         port_tx,
381                         port_conf.rx_adv_conf.rss_conf.rss_hf,
382                         conf.rx_adv_conf.rss_conf.rss_hf);
383         }
384
385         ret = rte_eth_dev_configure(port_tx, 1, 1, &conf);
386         if (ret < 0)
387                 rte_exit(EXIT_FAILURE, "Port %d configuration error (%d)\n", port_tx, ret);
388
389         nb_rxd = NIC_RX_QUEUE_DESC;
390         nb_txd = NIC_TX_QUEUE_DESC;
391         ret = rte_eth_dev_adjust_nb_rx_tx_desc(port_tx, &nb_rxd, &nb_txd);
392         if (ret < 0)
393                 rte_exit(EXIT_FAILURE, "Port %d adjust number of descriptors error (%d)\n",
394                                 port_tx, ret);
395
396         rxq_conf = dev_info.default_rxconf;
397         rxq_conf.offloads = conf.rxmode.offloads;
398         ret = rte_eth_rx_queue_setup(port_tx, NIC_RX_QUEUE, nb_rxd,
399                                 rte_eth_dev_socket_id(port_tx),
400                                 NULL, pool);
401         if (ret < 0)
402                 rte_exit(EXIT_FAILURE, "Port %d RX queue setup error (%d)\n", port_tx, ret);
403
404         txq_conf = dev_info.default_txconf;
405         txq_conf.offloads = conf.txmode.offloads;
406         ret = rte_eth_tx_queue_setup(port_tx, NIC_TX_QUEUE, nb_txd,
407                                 rte_eth_dev_socket_id(port_tx),
408                                 NULL);
409         if (ret < 0)
410                 rte_exit(EXIT_FAILURE, "Port %d TX queue setup error (%d)\n", port_tx, ret);
411
412         tx_buffer = rte_zmalloc_socket("tx_buffer",
413                         RTE_ETH_TX_BUFFER_SIZE(PKT_TX_BURST_MAX), 0,
414                         rte_eth_dev_socket_id(port_tx));
415         if (tx_buffer == NULL)
416                 rte_exit(EXIT_FAILURE, "Port %d TX buffer allocation error\n",
417                                 port_tx);
418
419         rte_eth_tx_buffer_init(tx_buffer, PKT_TX_BURST_MAX);
420
421         ret = rte_eth_dev_start(port_rx);
422         if (ret < 0)
423                 rte_exit(EXIT_FAILURE, "Port %d start error (%d)\n", port_rx, ret);
424
425         ret = rte_eth_dev_start(port_tx);
426         if (ret < 0)
427                 rte_exit(EXIT_FAILURE, "Port %d start error (%d)\n", port_tx, ret);
428
429         rte_eth_promiscuous_enable(port_rx);
430
431         rte_eth_promiscuous_enable(port_tx);
432
433         /* App configuration */
434         ret = app_configure_flow_table();
435         if (ret < 0)
436                 rte_exit(EXIT_FAILURE, "Invalid configure flow table\n");
437
438         /* Launch per-lcore init on every lcore */
439         rte_eal_mp_remote_launch(main_loop, NULL, CALL_MASTER);
440         RTE_LCORE_FOREACH_SLAVE(lcore_id) {
441                 if (rte_eal_wait_lcore(lcore_id) < 0)
442                         return -1;
443         }
444
445         return 0;
446 }