app/testpmd: add flow queue pull operation
[dpdk.git] / app / test-pmd / config.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2010-2016 Intel Corporation.
3  * Copyright 2013-2014 6WIND S.A.
4  */
5
6 #include <stdarg.h>
7 #include <errno.h>
8 #include <stdio.h>
9 #include <string.h>
10 #include <stdint.h>
11 #include <inttypes.h>
12
13 #include <sys/queue.h>
14 #include <sys/types.h>
15 #include <sys/stat.h>
16 #include <fcntl.h>
17 #include <unistd.h>
18
19 #include <rte_common.h>
20 #include <rte_byteorder.h>
21 #include <rte_debug.h>
22 #include <rte_log.h>
23 #include <rte_memory.h>
24 #include <rte_memcpy.h>
25 #include <rte_memzone.h>
26 #include <rte_launch.h>
27 #include <rte_eal.h>
28 #include <rte_per_lcore.h>
29 #include <rte_lcore.h>
30 #include <rte_branch_prediction.h>
31 #include <rte_mempool.h>
32 #include <rte_mbuf.h>
33 #include <rte_interrupts.h>
34 #include <rte_pci.h>
35 #include <rte_ether.h>
36 #include <rte_ethdev.h>
37 #include <rte_string_fns.h>
38 #include <rte_cycles.h>
39 #include <rte_flow.h>
40 #include <rte_mtr.h>
41 #include <rte_errno.h>
42 #ifdef RTE_NET_IXGBE
43 #include <rte_pmd_ixgbe.h>
44 #endif
45 #ifdef RTE_NET_I40E
46 #include <rte_pmd_i40e.h>
47 #endif
48 #ifdef RTE_NET_BNXT
49 #include <rte_pmd_bnxt.h>
50 #endif
51 #ifdef RTE_LIB_GRO
52 #include <rte_gro.h>
53 #endif
54 #include <rte_hexdump.h>
55
56 #include "testpmd.h"
57 #include "cmdline_mtr.h"
58
59 #define ETHDEV_FWVERS_LEN 32
60
61 #ifdef CLOCK_MONOTONIC_RAW /* Defined in glibc bits/time.h */
62 #define CLOCK_TYPE_ID CLOCK_MONOTONIC_RAW
63 #else
64 #define CLOCK_TYPE_ID CLOCK_MONOTONIC
65 #endif
66
67 #define NS_PER_SEC 1E9
68
69 static char *flowtype_to_str(uint16_t flow_type);
70
71 static const struct {
72         enum tx_pkt_split split;
73         const char *name;
74 } tx_split_name[] = {
75         {
76                 .split = TX_PKT_SPLIT_OFF,
77                 .name = "off",
78         },
79         {
80                 .split = TX_PKT_SPLIT_ON,
81                 .name = "on",
82         },
83         {
84                 .split = TX_PKT_SPLIT_RND,
85                 .name = "rand",
86         },
87 };
88
89 const struct rss_type_info rss_type_table[] = {
90         { "all", RTE_ETH_RSS_ETH | RTE_ETH_RSS_VLAN | RTE_ETH_RSS_IP | RTE_ETH_RSS_TCP |
91                 RTE_ETH_RSS_UDP | RTE_ETH_RSS_SCTP | RTE_ETH_RSS_L2_PAYLOAD |
92                 RTE_ETH_RSS_L2TPV3 | RTE_ETH_RSS_ESP | RTE_ETH_RSS_AH | RTE_ETH_RSS_PFCP |
93                 RTE_ETH_RSS_GTPU | RTE_ETH_RSS_ECPRI | RTE_ETH_RSS_MPLS | RTE_ETH_RSS_L2TPV2},
94         { "none", 0 },
95         { "eth", RTE_ETH_RSS_ETH },
96         { "l2-src-only", RTE_ETH_RSS_L2_SRC_ONLY },
97         { "l2-dst-only", RTE_ETH_RSS_L2_DST_ONLY },
98         { "vlan", RTE_ETH_RSS_VLAN },
99         { "s-vlan", RTE_ETH_RSS_S_VLAN },
100         { "c-vlan", RTE_ETH_RSS_C_VLAN },
101         { "ipv4", RTE_ETH_RSS_IPV4 },
102         { "ipv4-frag", RTE_ETH_RSS_FRAG_IPV4 },
103         { "ipv4-tcp", RTE_ETH_RSS_NONFRAG_IPV4_TCP },
104         { "ipv4-udp", RTE_ETH_RSS_NONFRAG_IPV4_UDP },
105         { "ipv4-sctp", RTE_ETH_RSS_NONFRAG_IPV4_SCTP },
106         { "ipv4-other", RTE_ETH_RSS_NONFRAG_IPV4_OTHER },
107         { "ipv6", RTE_ETH_RSS_IPV6 },
108         { "ipv6-frag", RTE_ETH_RSS_FRAG_IPV6 },
109         { "ipv6-tcp", RTE_ETH_RSS_NONFRAG_IPV6_TCP },
110         { "ipv6-udp", RTE_ETH_RSS_NONFRAG_IPV6_UDP },
111         { "ipv6-sctp", RTE_ETH_RSS_NONFRAG_IPV6_SCTP },
112         { "ipv6-other", RTE_ETH_RSS_NONFRAG_IPV6_OTHER },
113         { "l2-payload", RTE_ETH_RSS_L2_PAYLOAD },
114         { "ipv6-ex", RTE_ETH_RSS_IPV6_EX },
115         { "ipv6-tcp-ex", RTE_ETH_RSS_IPV6_TCP_EX },
116         { "ipv6-udp-ex", RTE_ETH_RSS_IPV6_UDP_EX },
117         { "port", RTE_ETH_RSS_PORT },
118         { "vxlan", RTE_ETH_RSS_VXLAN },
119         { "geneve", RTE_ETH_RSS_GENEVE },
120         { "nvgre", RTE_ETH_RSS_NVGRE },
121         { "ip", RTE_ETH_RSS_IP },
122         { "udp", RTE_ETH_RSS_UDP },
123         { "tcp", RTE_ETH_RSS_TCP },
124         { "sctp", RTE_ETH_RSS_SCTP },
125         { "tunnel", RTE_ETH_RSS_TUNNEL },
126         { "l3-pre32", RTE_ETH_RSS_L3_PRE32 },
127         { "l3-pre40", RTE_ETH_RSS_L3_PRE40 },
128         { "l3-pre48", RTE_ETH_RSS_L3_PRE48 },
129         { "l3-pre56", RTE_ETH_RSS_L3_PRE56 },
130         { "l3-pre64", RTE_ETH_RSS_L3_PRE64 },
131         { "l3-pre96", RTE_ETH_RSS_L3_PRE96 },
132         { "l3-src-only", RTE_ETH_RSS_L3_SRC_ONLY },
133         { "l3-dst-only", RTE_ETH_RSS_L3_DST_ONLY },
134         { "l4-src-only", RTE_ETH_RSS_L4_SRC_ONLY },
135         { "l4-dst-only", RTE_ETH_RSS_L4_DST_ONLY },
136         { "esp", RTE_ETH_RSS_ESP },
137         { "ah", RTE_ETH_RSS_AH },
138         { "l2tpv3", RTE_ETH_RSS_L2TPV3 },
139         { "pfcp", RTE_ETH_RSS_PFCP },
140         { "pppoe", RTE_ETH_RSS_PPPOE },
141         { "gtpu", RTE_ETH_RSS_GTPU },
142         { "ecpri", RTE_ETH_RSS_ECPRI },
143         { "mpls", RTE_ETH_RSS_MPLS },
144         { "ipv4-chksum", RTE_ETH_RSS_IPV4_CHKSUM },
145         { "l4-chksum", RTE_ETH_RSS_L4_CHKSUM },
146         { "l2tpv2", RTE_ETH_RSS_L2TPV2 },
147         { NULL, 0 },
148 };
149
150 static const struct {
151         enum rte_eth_fec_mode mode;
152         const char *name;
153 } fec_mode_name[] = {
154         {
155                 .mode = RTE_ETH_FEC_NOFEC,
156                 .name = "off",
157         },
158         {
159                 .mode = RTE_ETH_FEC_AUTO,
160                 .name = "auto",
161         },
162         {
163                 .mode = RTE_ETH_FEC_BASER,
164                 .name = "baser",
165         },
166         {
167                 .mode = RTE_ETH_FEC_RS,
168                 .name = "rs",
169         },
170 };
171
172 static void
173 print_ethaddr(const char *name, struct rte_ether_addr *eth_addr)
174 {
175         char buf[RTE_ETHER_ADDR_FMT_SIZE];
176         rte_ether_format_addr(buf, RTE_ETHER_ADDR_FMT_SIZE, eth_addr);
177         printf("%s%s", name, buf);
178 }
179
180 static void
181 nic_xstats_display_periodic(portid_t port_id)
182 {
183         struct xstat_display_info *xstats_info;
184         uint64_t *prev_values, *curr_values;
185         uint64_t diff_value, value_rate;
186         struct timespec cur_time;
187         uint64_t *ids_supp;
188         size_t ids_supp_sz;
189         uint64_t diff_ns;
190         unsigned int i;
191         int rc;
192
193         xstats_info = &ports[port_id].xstats_info;
194
195         ids_supp_sz = xstats_info->ids_supp_sz;
196         if (ids_supp_sz == 0)
197                 return;
198
199         printf("\n");
200
201         ids_supp = xstats_info->ids_supp;
202         prev_values = xstats_info->prev_values;
203         curr_values = xstats_info->curr_values;
204
205         rc = rte_eth_xstats_get_by_id(port_id, ids_supp, curr_values,
206                                       ids_supp_sz);
207         if (rc != (int)ids_supp_sz) {
208                 fprintf(stderr,
209                         "Failed to get values of %zu xstats for port %u - return code %d\n",
210                         ids_supp_sz, port_id, rc);
211                 return;
212         }
213
214         diff_ns = 0;
215         if (clock_gettime(CLOCK_TYPE_ID, &cur_time) == 0) {
216                 uint64_t ns;
217
218                 ns = cur_time.tv_sec * NS_PER_SEC;
219                 ns += cur_time.tv_nsec;
220
221                 if (xstats_info->prev_ns != 0)
222                         diff_ns = ns - xstats_info->prev_ns;
223                 xstats_info->prev_ns = ns;
224         }
225
226         printf("%-31s%-17s%s\n", " ", "Value", "Rate (since last show)");
227         for (i = 0; i < ids_supp_sz; i++) {
228                 diff_value = (curr_values[i] > prev_values[i]) ?
229                              (curr_values[i] - prev_values[i]) : 0;
230                 prev_values[i] = curr_values[i];
231                 value_rate = diff_ns > 0 ?
232                                 (double)diff_value / diff_ns * NS_PER_SEC : 0;
233
234                 printf("  %-25s%12"PRIu64" %15"PRIu64"\n",
235                        xstats_display[i].name, curr_values[i], value_rate);
236         }
237 }
238
239 void
240 nic_stats_display(portid_t port_id)
241 {
242         static uint64_t prev_pkts_rx[RTE_MAX_ETHPORTS];
243         static uint64_t prev_pkts_tx[RTE_MAX_ETHPORTS];
244         static uint64_t prev_bytes_rx[RTE_MAX_ETHPORTS];
245         static uint64_t prev_bytes_tx[RTE_MAX_ETHPORTS];
246         static uint64_t prev_ns[RTE_MAX_ETHPORTS];
247         struct timespec cur_time;
248         uint64_t diff_pkts_rx, diff_pkts_tx, diff_bytes_rx, diff_bytes_tx,
249                                                                 diff_ns;
250         uint64_t mpps_rx, mpps_tx, mbps_rx, mbps_tx;
251         struct rte_eth_stats stats;
252
253         static const char *nic_stats_border = "########################";
254
255         if (port_id_is_invalid(port_id, ENABLED_WARN)) {
256                 print_valid_ports();
257                 return;
258         }
259         rte_eth_stats_get(port_id, &stats);
260         printf("\n  %s NIC statistics for port %-2d %s\n",
261                nic_stats_border, port_id, nic_stats_border);
262
263         printf("  RX-packets: %-10"PRIu64" RX-missed: %-10"PRIu64" RX-bytes:  "
264                "%-"PRIu64"\n", stats.ipackets, stats.imissed, stats.ibytes);
265         printf("  RX-errors: %-"PRIu64"\n", stats.ierrors);
266         printf("  RX-nombuf:  %-10"PRIu64"\n", stats.rx_nombuf);
267         printf("  TX-packets: %-10"PRIu64" TX-errors: %-10"PRIu64" TX-bytes:  "
268                "%-"PRIu64"\n", stats.opackets, stats.oerrors, stats.obytes);
269
270         diff_ns = 0;
271         if (clock_gettime(CLOCK_TYPE_ID, &cur_time) == 0) {
272                 uint64_t ns;
273
274                 ns = cur_time.tv_sec * NS_PER_SEC;
275                 ns += cur_time.tv_nsec;
276
277                 if (prev_ns[port_id] != 0)
278                         diff_ns = ns - prev_ns[port_id];
279                 prev_ns[port_id] = ns;
280         }
281
282         diff_pkts_rx = (stats.ipackets > prev_pkts_rx[port_id]) ?
283                 (stats.ipackets - prev_pkts_rx[port_id]) : 0;
284         diff_pkts_tx = (stats.opackets > prev_pkts_tx[port_id]) ?
285                 (stats.opackets - prev_pkts_tx[port_id]) : 0;
286         prev_pkts_rx[port_id] = stats.ipackets;
287         prev_pkts_tx[port_id] = stats.opackets;
288         mpps_rx = diff_ns > 0 ?
289                 (double)diff_pkts_rx / diff_ns * NS_PER_SEC : 0;
290         mpps_tx = diff_ns > 0 ?
291                 (double)diff_pkts_tx / diff_ns * NS_PER_SEC : 0;
292
293         diff_bytes_rx = (stats.ibytes > prev_bytes_rx[port_id]) ?
294                 (stats.ibytes - prev_bytes_rx[port_id]) : 0;
295         diff_bytes_tx = (stats.obytes > prev_bytes_tx[port_id]) ?
296                 (stats.obytes - prev_bytes_tx[port_id]) : 0;
297         prev_bytes_rx[port_id] = stats.ibytes;
298         prev_bytes_tx[port_id] = stats.obytes;
299         mbps_rx = diff_ns > 0 ?
300                 (double)diff_bytes_rx / diff_ns * NS_PER_SEC : 0;
301         mbps_tx = diff_ns > 0 ?
302                 (double)diff_bytes_tx / diff_ns * NS_PER_SEC : 0;
303
304         printf("\n  Throughput (since last show)\n");
305         printf("  Rx-pps: %12"PRIu64"          Rx-bps: %12"PRIu64"\n  Tx-pps: %12"
306                PRIu64"          Tx-bps: %12"PRIu64"\n", mpps_rx, mbps_rx * 8,
307                mpps_tx, mbps_tx * 8);
308
309         if (xstats_display_num > 0)
310                 nic_xstats_display_periodic(port_id);
311
312         printf("  %s############################%s\n",
313                nic_stats_border, nic_stats_border);
314 }
315
316 void
317 nic_stats_clear(portid_t port_id)
318 {
319         int ret;
320
321         if (port_id_is_invalid(port_id, ENABLED_WARN)) {
322                 print_valid_ports();
323                 return;
324         }
325
326         ret = rte_eth_stats_reset(port_id);
327         if (ret != 0) {
328                 fprintf(stderr,
329                         "%s: Error: failed to reset stats (port %u): %s",
330                         __func__, port_id, strerror(-ret));
331                 return;
332         }
333
334         ret = rte_eth_stats_get(port_id, &ports[port_id].stats);
335         if (ret != 0) {
336                 if (ret < 0)
337                         ret = -ret;
338                 fprintf(stderr,
339                         "%s: Error: failed to get stats (port %u): %s",
340                         __func__, port_id, strerror(ret));
341                 return;
342         }
343         printf("\n  NIC statistics for port %d cleared\n", port_id);
344 }
345
346 void
347 nic_xstats_display(portid_t port_id)
348 {
349         struct rte_eth_xstat *xstats;
350         int cnt_xstats, idx_xstat;
351         struct rte_eth_xstat_name *xstats_names;
352
353         if (port_id_is_invalid(port_id, ENABLED_WARN)) {
354                 print_valid_ports();
355                 return;
356         }
357         printf("###### NIC extended statistics for port %-2d\n", port_id);
358         if (!rte_eth_dev_is_valid_port(port_id)) {
359                 fprintf(stderr, "Error: Invalid port number %i\n", port_id);
360                 return;
361         }
362
363         /* Get count */
364         cnt_xstats = rte_eth_xstats_get_names(port_id, NULL, 0);
365         if (cnt_xstats  < 0) {
366                 fprintf(stderr, "Error: Cannot get count of xstats\n");
367                 return;
368         }
369
370         /* Get id-name lookup table */
371         xstats_names = malloc(sizeof(struct rte_eth_xstat_name) * cnt_xstats);
372         if (xstats_names == NULL) {
373                 fprintf(stderr, "Cannot allocate memory for xstats lookup\n");
374                 return;
375         }
376         if (cnt_xstats != rte_eth_xstats_get_names(
377                         port_id, xstats_names, cnt_xstats)) {
378                 fprintf(stderr, "Error: Cannot get xstats lookup\n");
379                 free(xstats_names);
380                 return;
381         }
382
383         /* Get stats themselves */
384         xstats = malloc(sizeof(struct rte_eth_xstat) * cnt_xstats);
385         if (xstats == NULL) {
386                 fprintf(stderr, "Cannot allocate memory for xstats\n");
387                 free(xstats_names);
388                 return;
389         }
390         if (cnt_xstats != rte_eth_xstats_get(port_id, xstats, cnt_xstats)) {
391                 fprintf(stderr, "Error: Unable to get xstats\n");
392                 free(xstats_names);
393                 free(xstats);
394                 return;
395         }
396
397         /* Display xstats */
398         for (idx_xstat = 0; idx_xstat < cnt_xstats; idx_xstat++) {
399                 if (xstats_hide_zero && !xstats[idx_xstat].value)
400                         continue;
401                 printf("%s: %"PRIu64"\n",
402                         xstats_names[idx_xstat].name,
403                         xstats[idx_xstat].value);
404         }
405         free(xstats_names);
406         free(xstats);
407 }
408
409 void
410 nic_xstats_clear(portid_t port_id)
411 {
412         int ret;
413
414         if (port_id_is_invalid(port_id, ENABLED_WARN)) {
415                 print_valid_ports();
416                 return;
417         }
418
419         ret = rte_eth_xstats_reset(port_id);
420         if (ret != 0) {
421                 fprintf(stderr,
422                         "%s: Error: failed to reset xstats (port %u): %s\n",
423                         __func__, port_id, strerror(-ret));
424                 return;
425         }
426
427         ret = rte_eth_stats_get(port_id, &ports[port_id].stats);
428         if (ret != 0) {
429                 if (ret < 0)
430                         ret = -ret;
431                 fprintf(stderr, "%s: Error: failed to get stats (port %u): %s",
432                         __func__, port_id, strerror(ret));
433                 return;
434         }
435 }
436
437 static const char *
438 get_queue_state_name(uint8_t queue_state)
439 {
440         if (queue_state == RTE_ETH_QUEUE_STATE_STOPPED)
441                 return "stopped";
442         else if (queue_state == RTE_ETH_QUEUE_STATE_STARTED)
443                 return "started";
444         else if (queue_state == RTE_ETH_QUEUE_STATE_HAIRPIN)
445                 return "hairpin";
446         else
447                 return "unknown";
448 }
449
450 void
451 rx_queue_infos_display(portid_t port_id, uint16_t queue_id)
452 {
453         struct rte_eth_burst_mode mode;
454         struct rte_eth_rxq_info qinfo;
455         int32_t rc;
456         static const char *info_border = "*********************";
457
458         rc = rte_eth_rx_queue_info_get(port_id, queue_id, &qinfo);
459         if (rc != 0) {
460                 fprintf(stderr,
461                         "Failed to retrieve information for port: %u, RX queue: %hu\nerror desc: %s(%d)\n",
462                         port_id, queue_id, strerror(-rc), rc);
463                 return;
464         }
465
466         printf("\n%s Infos for port %-2u, RX queue %-2u %s",
467                info_border, port_id, queue_id, info_border);
468
469         printf("\nMempool: %s", (qinfo.mp == NULL) ? "NULL" : qinfo.mp->name);
470         printf("\nRX prefetch threshold: %hhu", qinfo.conf.rx_thresh.pthresh);
471         printf("\nRX host threshold: %hhu", qinfo.conf.rx_thresh.hthresh);
472         printf("\nRX writeback threshold: %hhu", qinfo.conf.rx_thresh.wthresh);
473         printf("\nRX free threshold: %hu", qinfo.conf.rx_free_thresh);
474         printf("\nRX drop packets: %s",
475                 (qinfo.conf.rx_drop_en != 0) ? "on" : "off");
476         printf("\nRX deferred start: %s",
477                 (qinfo.conf.rx_deferred_start != 0) ? "on" : "off");
478         printf("\nRX scattered packets: %s",
479                 (qinfo.scattered_rx != 0) ? "on" : "off");
480         printf("\nRx queue state: %s", get_queue_state_name(qinfo.queue_state));
481         if (qinfo.rx_buf_size != 0)
482                 printf("\nRX buffer size: %hu", qinfo.rx_buf_size);
483         printf("\nNumber of RXDs: %hu", qinfo.nb_desc);
484
485         if (rte_eth_rx_burst_mode_get(port_id, queue_id, &mode) == 0)
486                 printf("\nBurst mode: %s%s",
487                        mode.info,
488                        mode.flags & RTE_ETH_BURST_FLAG_PER_QUEUE ?
489                                 " (per queue)" : "");
490
491         printf("\n");
492 }
493
494 void
495 tx_queue_infos_display(portid_t port_id, uint16_t queue_id)
496 {
497         struct rte_eth_burst_mode mode;
498         struct rte_eth_txq_info qinfo;
499         int32_t rc;
500         static const char *info_border = "*********************";
501
502         rc = rte_eth_tx_queue_info_get(port_id, queue_id, &qinfo);
503         if (rc != 0) {
504                 fprintf(stderr,
505                         "Failed to retrieve information for port: %u, TX queue: %hu\nerror desc: %s(%d)\n",
506                         port_id, queue_id, strerror(-rc), rc);
507                 return;
508         }
509
510         printf("\n%s Infos for port %-2u, TX queue %-2u %s",
511                info_border, port_id, queue_id, info_border);
512
513         printf("\nTX prefetch threshold: %hhu", qinfo.conf.tx_thresh.pthresh);
514         printf("\nTX host threshold: %hhu", qinfo.conf.tx_thresh.hthresh);
515         printf("\nTX writeback threshold: %hhu", qinfo.conf.tx_thresh.wthresh);
516         printf("\nTX RS threshold: %hu", qinfo.conf.tx_rs_thresh);
517         printf("\nTX free threshold: %hu", qinfo.conf.tx_free_thresh);
518         printf("\nTX deferred start: %s",
519                 (qinfo.conf.tx_deferred_start != 0) ? "on" : "off");
520         printf("\nNumber of TXDs: %hu", qinfo.nb_desc);
521         printf("\nTx queue state: %s", get_queue_state_name(qinfo.queue_state));
522
523         if (rte_eth_tx_burst_mode_get(port_id, queue_id, &mode) == 0)
524                 printf("\nBurst mode: %s%s",
525                        mode.info,
526                        mode.flags & RTE_ETH_BURST_FLAG_PER_QUEUE ?
527                                 " (per queue)" : "");
528
529         printf("\n");
530 }
531
532 static int bus_match_all(const struct rte_bus *bus, const void *data)
533 {
534         RTE_SET_USED(bus);
535         RTE_SET_USED(data);
536         return 0;
537 }
538
539 static void
540 device_infos_display_speeds(uint32_t speed_capa)
541 {
542         printf("\n\tDevice speed capability:");
543         if (speed_capa == RTE_ETH_LINK_SPEED_AUTONEG)
544                 printf(" Autonegotiate (all speeds)");
545         if (speed_capa & RTE_ETH_LINK_SPEED_FIXED)
546                 printf(" Disable autonegotiate (fixed speed)  ");
547         if (speed_capa & RTE_ETH_LINK_SPEED_10M_HD)
548                 printf(" 10 Mbps half-duplex  ");
549         if (speed_capa & RTE_ETH_LINK_SPEED_10M)
550                 printf(" 10 Mbps full-duplex  ");
551         if (speed_capa & RTE_ETH_LINK_SPEED_100M_HD)
552                 printf(" 100 Mbps half-duplex  ");
553         if (speed_capa & RTE_ETH_LINK_SPEED_100M)
554                 printf(" 100 Mbps full-duplex  ");
555         if (speed_capa & RTE_ETH_LINK_SPEED_1G)
556                 printf(" 1 Gbps  ");
557         if (speed_capa & RTE_ETH_LINK_SPEED_2_5G)
558                 printf(" 2.5 Gbps  ");
559         if (speed_capa & RTE_ETH_LINK_SPEED_5G)
560                 printf(" 5 Gbps  ");
561         if (speed_capa & RTE_ETH_LINK_SPEED_10G)
562                 printf(" 10 Gbps  ");
563         if (speed_capa & RTE_ETH_LINK_SPEED_20G)
564                 printf(" 20 Gbps  ");
565         if (speed_capa & RTE_ETH_LINK_SPEED_25G)
566                 printf(" 25 Gbps  ");
567         if (speed_capa & RTE_ETH_LINK_SPEED_40G)
568                 printf(" 40 Gbps  ");
569         if (speed_capa & RTE_ETH_LINK_SPEED_50G)
570                 printf(" 50 Gbps  ");
571         if (speed_capa & RTE_ETH_LINK_SPEED_56G)
572                 printf(" 56 Gbps  ");
573         if (speed_capa & RTE_ETH_LINK_SPEED_100G)
574                 printf(" 100 Gbps  ");
575         if (speed_capa & RTE_ETH_LINK_SPEED_200G)
576                 printf(" 200 Gbps  ");
577 }
578
579 void
580 device_infos_display(const char *identifier)
581 {
582         static const char *info_border = "*********************";
583         struct rte_bus *start = NULL, *next;
584         struct rte_dev_iterator dev_iter;
585         char name[RTE_ETH_NAME_MAX_LEN];
586         struct rte_ether_addr mac_addr;
587         struct rte_device *dev;
588         struct rte_devargs da;
589         portid_t port_id;
590         struct rte_eth_dev_info dev_info;
591         char devstr[128];
592
593         memset(&da, 0, sizeof(da));
594         if (!identifier)
595                 goto skip_parse;
596
597         if (rte_devargs_parsef(&da, "%s", identifier)) {
598                 fprintf(stderr, "cannot parse identifier\n");
599                 return;
600         }
601
602 skip_parse:
603         while ((next = rte_bus_find(start, bus_match_all, NULL)) != NULL) {
604
605                 start = next;
606                 if (identifier && da.bus != next)
607                         continue;
608
609                 /* Skip buses that don't have iterate method */
610                 if (!next->dev_iterate)
611                         continue;
612
613                 snprintf(devstr, sizeof(devstr), "bus=%s", next->name);
614                 RTE_DEV_FOREACH(dev, devstr, &dev_iter) {
615
616                         if (!dev->driver)
617                                 continue;
618                         /* Check for matching device if identifier is present */
619                         if (identifier &&
620                             strncmp(da.name, dev->name, strlen(dev->name)))
621                                 continue;
622                         printf("\n%s Infos for device %s %s\n",
623                                info_border, dev->name, info_border);
624                         printf("Bus name: %s", dev->bus->name);
625                         printf("\nDriver name: %s", dev->driver->name);
626                         printf("\nDevargs: %s",
627                                dev->devargs ? dev->devargs->args : "");
628                         printf("\nConnect to socket: %d", dev->numa_node);
629                         printf("\n");
630
631                         /* List ports with matching device name */
632                         RTE_ETH_FOREACH_DEV_OF(port_id, dev) {
633                                 printf("\n\tPort id: %-2d", port_id);
634                                 if (eth_macaddr_get_print_err(port_id,
635                                                               &mac_addr) == 0)
636                                         print_ethaddr("\n\tMAC address: ",
637                                                       &mac_addr);
638                                 rte_eth_dev_get_name_by_port(port_id, name);
639                                 printf("\n\tDevice name: %s", name);
640                                 if (rte_eth_dev_info_get(port_id, &dev_info) == 0)
641                                         device_infos_display_speeds(dev_info.speed_capa);
642                                 printf("\n");
643                         }
644                 }
645         };
646         rte_devargs_reset(&da);
647 }
648
649 static void
650 print_dev_capabilities(uint64_t capabilities)
651 {
652         uint64_t single_capa;
653         int begin;
654         int end;
655         int bit;
656
657         if (capabilities == 0)
658                 return;
659
660         begin = __builtin_ctzll(capabilities);
661         end = sizeof(capabilities) * CHAR_BIT - __builtin_clzll(capabilities);
662
663         single_capa = 1ULL << begin;
664         for (bit = begin; bit < end; bit++) {
665                 if (capabilities & single_capa)
666                         printf(" %s",
667                                rte_eth_dev_capability_name(single_capa));
668                 single_capa <<= 1;
669         }
670 }
671
672 void
673 port_infos_display(portid_t port_id)
674 {
675         struct rte_port *port;
676         struct rte_ether_addr mac_addr;
677         struct rte_eth_link link;
678         struct rte_eth_dev_info dev_info;
679         int vlan_offload;
680         struct rte_mempool * mp;
681         static const char *info_border = "*********************";
682         uint16_t mtu;
683         char name[RTE_ETH_NAME_MAX_LEN];
684         int ret;
685         char fw_version[ETHDEV_FWVERS_LEN];
686
687         if (port_id_is_invalid(port_id, ENABLED_WARN)) {
688                 print_valid_ports();
689                 return;
690         }
691         port = &ports[port_id];
692         ret = eth_link_get_nowait_print_err(port_id, &link);
693         if (ret < 0)
694                 return;
695
696         ret = eth_dev_info_get_print_err(port_id, &dev_info);
697         if (ret != 0)
698                 return;
699
700         printf("\n%s Infos for port %-2d %s\n",
701                info_border, port_id, info_border);
702         if (eth_macaddr_get_print_err(port_id, &mac_addr) == 0)
703                 print_ethaddr("MAC address: ", &mac_addr);
704         rte_eth_dev_get_name_by_port(port_id, name);
705         printf("\nDevice name: %s", name);
706         printf("\nDriver name: %s", dev_info.driver_name);
707
708         if (rte_eth_dev_fw_version_get(port_id, fw_version,
709                                                 ETHDEV_FWVERS_LEN) == 0)
710                 printf("\nFirmware-version: %s", fw_version);
711         else
712                 printf("\nFirmware-version: %s", "not available");
713
714         if (dev_info.device->devargs && dev_info.device->devargs->args)
715                 printf("\nDevargs: %s", dev_info.device->devargs->args);
716         printf("\nConnect to socket: %u", port->socket_id);
717
718         if (port_numa[port_id] != NUMA_NO_CONFIG) {
719                 mp = mbuf_pool_find(port_numa[port_id], 0);
720                 if (mp)
721                         printf("\nmemory allocation on the socket: %d",
722                                                         port_numa[port_id]);
723         } else
724                 printf("\nmemory allocation on the socket: %u",port->socket_id);
725
726         printf("\nLink status: %s\n", (link.link_status) ? ("up") : ("down"));
727         printf("Link speed: %s\n", rte_eth_link_speed_to_str(link.link_speed));
728         printf("Link duplex: %s\n", (link.link_duplex == RTE_ETH_LINK_FULL_DUPLEX) ?
729                ("full-duplex") : ("half-duplex"));
730         printf("Autoneg status: %s\n", (link.link_autoneg == RTE_ETH_LINK_AUTONEG) ?
731                ("On") : ("Off"));
732
733         if (!rte_eth_dev_get_mtu(port_id, &mtu))
734                 printf("MTU: %u\n", mtu);
735
736         printf("Promiscuous mode: %s\n",
737                rte_eth_promiscuous_get(port_id) ? "enabled" : "disabled");
738         printf("Allmulticast mode: %s\n",
739                rte_eth_allmulticast_get(port_id) ? "enabled" : "disabled");
740         printf("Maximum number of MAC addresses: %u\n",
741                (unsigned int)(port->dev_info.max_mac_addrs));
742         printf("Maximum number of MAC addresses of hash filtering: %u\n",
743                (unsigned int)(port->dev_info.max_hash_mac_addrs));
744
745         vlan_offload = rte_eth_dev_get_vlan_offload(port_id);
746         if (vlan_offload >= 0){
747                 printf("VLAN offload: \n");
748                 if (vlan_offload & RTE_ETH_VLAN_STRIP_OFFLOAD)
749                         printf("  strip on, ");
750                 else
751                         printf("  strip off, ");
752
753                 if (vlan_offload & RTE_ETH_VLAN_FILTER_OFFLOAD)
754                         printf("filter on, ");
755                 else
756                         printf("filter off, ");
757
758                 if (vlan_offload & RTE_ETH_VLAN_EXTEND_OFFLOAD)
759                         printf("extend on, ");
760                 else
761                         printf("extend off, ");
762
763                 if (vlan_offload & RTE_ETH_QINQ_STRIP_OFFLOAD)
764                         printf("qinq strip on\n");
765                 else
766                         printf("qinq strip off\n");
767         }
768
769         if (dev_info.hash_key_size > 0)
770                 printf("Hash key size in bytes: %u\n", dev_info.hash_key_size);
771         if (dev_info.reta_size > 0)
772                 printf("Redirection table size: %u\n", dev_info.reta_size);
773         if (!dev_info.flow_type_rss_offloads)
774                 printf("No RSS offload flow type is supported.\n");
775         else {
776                 uint16_t i;
777                 char *p;
778
779                 printf("Supported RSS offload flow types:\n");
780                 for (i = RTE_ETH_FLOW_UNKNOWN + 1;
781                      i < sizeof(dev_info.flow_type_rss_offloads) * CHAR_BIT; i++) {
782                         if (!(dev_info.flow_type_rss_offloads & (1ULL << i)))
783                                 continue;
784                         p = flowtype_to_str(i);
785                         if (p)
786                                 printf("  %s\n", p);
787                         else
788                                 printf("  user defined %d\n", i);
789                 }
790         }
791
792         printf("Minimum size of RX buffer: %u\n", dev_info.min_rx_bufsize);
793         printf("Maximum configurable length of RX packet: %u\n",
794                 dev_info.max_rx_pktlen);
795         printf("Maximum configurable size of LRO aggregated packet: %u\n",
796                 dev_info.max_lro_pkt_size);
797         if (dev_info.max_vfs)
798                 printf("Maximum number of VFs: %u\n", dev_info.max_vfs);
799         if (dev_info.max_vmdq_pools)
800                 printf("Maximum number of VMDq pools: %u\n",
801                         dev_info.max_vmdq_pools);
802
803         printf("Current number of RX queues: %u\n", dev_info.nb_rx_queues);
804         printf("Max possible RX queues: %u\n", dev_info.max_rx_queues);
805         printf("Max possible number of RXDs per queue: %hu\n",
806                 dev_info.rx_desc_lim.nb_max);
807         printf("Min possible number of RXDs per queue: %hu\n",
808                 dev_info.rx_desc_lim.nb_min);
809         printf("RXDs number alignment: %hu\n", dev_info.rx_desc_lim.nb_align);
810
811         printf("Current number of TX queues: %u\n", dev_info.nb_tx_queues);
812         printf("Max possible TX queues: %u\n", dev_info.max_tx_queues);
813         printf("Max possible number of TXDs per queue: %hu\n",
814                 dev_info.tx_desc_lim.nb_max);
815         printf("Min possible number of TXDs per queue: %hu\n",
816                 dev_info.tx_desc_lim.nb_min);
817         printf("TXDs number alignment: %hu\n", dev_info.tx_desc_lim.nb_align);
818         printf("Max segment number per packet: %hu\n",
819                 dev_info.tx_desc_lim.nb_seg_max);
820         printf("Max segment number per MTU/TSO: %hu\n",
821                 dev_info.tx_desc_lim.nb_mtu_seg_max);
822
823         printf("Device capabilities: 0x%"PRIx64"(", dev_info.dev_capa);
824         print_dev_capabilities(dev_info.dev_capa);
825         printf(" )\n");
826         /* Show switch info only if valid switch domain and port id is set */
827         if (dev_info.switch_info.domain_id !=
828                 RTE_ETH_DEV_SWITCH_DOMAIN_ID_INVALID) {
829                 if (dev_info.switch_info.name)
830                         printf("Switch name: %s\n", dev_info.switch_info.name);
831
832                 printf("Switch domain Id: %u\n",
833                         dev_info.switch_info.domain_id);
834                 printf("Switch Port Id: %u\n",
835                         dev_info.switch_info.port_id);
836                 if ((dev_info.dev_capa & RTE_ETH_DEV_CAPA_RXQ_SHARE) != 0)
837                         printf("Switch Rx domain: %u\n",
838                                dev_info.switch_info.rx_domain);
839         }
840 }
841
842 void
843 port_summary_header_display(void)
844 {
845         uint16_t port_number;
846
847         port_number = rte_eth_dev_count_avail();
848         printf("Number of available ports: %i\n", port_number);
849         printf("%-4s %-17s %-12s %-14s %-8s %s\n", "Port", "MAC Address", "Name",
850                         "Driver", "Status", "Link");
851 }
852
853 void
854 port_summary_display(portid_t port_id)
855 {
856         struct rte_ether_addr mac_addr;
857         struct rte_eth_link link;
858         struct rte_eth_dev_info dev_info;
859         char name[RTE_ETH_NAME_MAX_LEN];
860         int ret;
861
862         if (port_id_is_invalid(port_id, ENABLED_WARN)) {
863                 print_valid_ports();
864                 return;
865         }
866
867         ret = eth_link_get_nowait_print_err(port_id, &link);
868         if (ret < 0)
869                 return;
870
871         ret = eth_dev_info_get_print_err(port_id, &dev_info);
872         if (ret != 0)
873                 return;
874
875         rte_eth_dev_get_name_by_port(port_id, name);
876         ret = eth_macaddr_get_print_err(port_id, &mac_addr);
877         if (ret != 0)
878                 return;
879
880         printf("%-4d " RTE_ETHER_ADDR_PRT_FMT " %-12s %-14s %-8s %s\n",
881                 port_id, RTE_ETHER_ADDR_BYTES(&mac_addr), name,
882                 dev_info.driver_name, (link.link_status) ? ("up") : ("down"),
883                 rte_eth_link_speed_to_str(link.link_speed));
884 }
885
886 void
887 port_eeprom_display(portid_t port_id)
888 {
889         struct rte_dev_eeprom_info einfo;
890         int ret;
891         if (port_id_is_invalid(port_id, ENABLED_WARN)) {
892                 print_valid_ports();
893                 return;
894         }
895
896         int len_eeprom = rte_eth_dev_get_eeprom_length(port_id);
897         if (len_eeprom < 0) {
898                 switch (len_eeprom) {
899                 case -ENODEV:
900                         fprintf(stderr, "port index %d invalid\n", port_id);
901                         break;
902                 case -ENOTSUP:
903                         fprintf(stderr, "operation not supported by device\n");
904                         break;
905                 case -EIO:
906                         fprintf(stderr, "device is removed\n");
907                         break;
908                 default:
909                         fprintf(stderr, "Unable to get EEPROM: %d\n",
910                                 len_eeprom);
911                         break;
912                 }
913                 return;
914         }
915
916         einfo.offset = 0;
917         einfo.length = len_eeprom;
918         einfo.data = calloc(1, len_eeprom);
919         if (!einfo.data) {
920                 fprintf(stderr,
921                         "Allocation of port %u eeprom data failed\n",
922                         port_id);
923                 return;
924         }
925
926         ret = rte_eth_dev_get_eeprom(port_id, &einfo);
927         if (ret != 0) {
928                 switch (ret) {
929                 case -ENODEV:
930                         fprintf(stderr, "port index %d invalid\n", port_id);
931                         break;
932                 case -ENOTSUP:
933                         fprintf(stderr, "operation not supported by device\n");
934                         break;
935                 case -EIO:
936                         fprintf(stderr, "device is removed\n");
937                         break;
938                 default:
939                         fprintf(stderr, "Unable to get EEPROM: %d\n", ret);
940                         break;
941                 }
942                 free(einfo.data);
943                 return;
944         }
945         rte_hexdump(stdout, "hexdump", einfo.data, einfo.length);
946         printf("Finish -- Port: %d EEPROM length: %d bytes\n", port_id, len_eeprom);
947         free(einfo.data);
948 }
949
950 void
951 port_module_eeprom_display(portid_t port_id)
952 {
953         struct rte_eth_dev_module_info minfo;
954         struct rte_dev_eeprom_info einfo;
955         int ret;
956
957         if (port_id_is_invalid(port_id, ENABLED_WARN)) {
958                 print_valid_ports();
959                 return;
960         }
961
962
963         ret = rte_eth_dev_get_module_info(port_id, &minfo);
964         if (ret != 0) {
965                 switch (ret) {
966                 case -ENODEV:
967                         fprintf(stderr, "port index %d invalid\n", port_id);
968                         break;
969                 case -ENOTSUP:
970                         fprintf(stderr, "operation not supported by device\n");
971                         break;
972                 case -EIO:
973                         fprintf(stderr, "device is removed\n");
974                         break;
975                 default:
976                         fprintf(stderr, "Unable to get module EEPROM: %d\n",
977                                 ret);
978                         break;
979                 }
980                 return;
981         }
982
983         einfo.offset = 0;
984         einfo.length = minfo.eeprom_len;
985         einfo.data = calloc(1, minfo.eeprom_len);
986         if (!einfo.data) {
987                 fprintf(stderr,
988                         "Allocation of port %u eeprom data failed\n",
989                         port_id);
990                 return;
991         }
992
993         ret = rte_eth_dev_get_module_eeprom(port_id, &einfo);
994         if (ret != 0) {
995                 switch (ret) {
996                 case -ENODEV:
997                         fprintf(stderr, "port index %d invalid\n", port_id);
998                         break;
999                 case -ENOTSUP:
1000                         fprintf(stderr, "operation not supported by device\n");
1001                         break;
1002                 case -EIO:
1003                         fprintf(stderr, "device is removed\n");
1004                         break;
1005                 default:
1006                         fprintf(stderr, "Unable to get module EEPROM: %d\n",
1007                                 ret);
1008                         break;
1009                 }
1010                 free(einfo.data);
1011                 return;
1012         }
1013
1014         rte_hexdump(stdout, "hexdump", einfo.data, einfo.length);
1015         printf("Finish -- Port: %d MODULE EEPROM length: %d bytes\n", port_id, einfo.length);
1016         free(einfo.data);
1017 }
1018
1019 int
1020 port_id_is_invalid(portid_t port_id, enum print_warning warning)
1021 {
1022         uint16_t pid;
1023
1024         if (port_id == (portid_t)RTE_PORT_ALL)
1025                 return 0;
1026
1027         RTE_ETH_FOREACH_DEV(pid)
1028                 if (port_id == pid)
1029                         return 0;
1030
1031         if (warning == ENABLED_WARN)
1032                 fprintf(stderr, "Invalid port %d\n", port_id);
1033
1034         return 1;
1035 }
1036
1037 void print_valid_ports(void)
1038 {
1039         portid_t pid;
1040
1041         printf("The valid ports array is [");
1042         RTE_ETH_FOREACH_DEV(pid) {
1043                 printf(" %d", pid);
1044         }
1045         printf(" ]\n");
1046 }
1047
1048 static int
1049 vlan_id_is_invalid(uint16_t vlan_id)
1050 {
1051         if (vlan_id < 4096)
1052                 return 0;
1053         fprintf(stderr, "Invalid vlan_id %d (must be < 4096)\n", vlan_id);
1054         return 1;
1055 }
1056
1057 static int
1058 port_reg_off_is_invalid(portid_t port_id, uint32_t reg_off)
1059 {
1060         const struct rte_pci_device *pci_dev;
1061         const struct rte_bus *bus;
1062         uint64_t pci_len;
1063
1064         if (reg_off & 0x3) {
1065                 fprintf(stderr,
1066                         "Port register offset 0x%X not aligned on a 4-byte boundary\n",
1067                         (unsigned int)reg_off);
1068                 return 1;
1069         }
1070
1071         if (!ports[port_id].dev_info.device) {
1072                 fprintf(stderr, "Invalid device\n");
1073                 return 0;
1074         }
1075
1076         bus = rte_bus_find_by_device(ports[port_id].dev_info.device);
1077         if (bus && !strcmp(bus->name, "pci")) {
1078                 pci_dev = RTE_DEV_TO_PCI(ports[port_id].dev_info.device);
1079         } else {
1080                 fprintf(stderr, "Not a PCI device\n");
1081                 return 1;
1082         }
1083
1084         pci_len = pci_dev->mem_resource[0].len;
1085         if (reg_off >= pci_len) {
1086                 fprintf(stderr,
1087                         "Port %d: register offset %u (0x%X) out of port PCI resource (length=%"PRIu64")\n",
1088                         port_id, (unsigned int)reg_off, (unsigned int)reg_off,
1089                         pci_len);
1090                 return 1;
1091         }
1092         return 0;
1093 }
1094
1095 static int
1096 reg_bit_pos_is_invalid(uint8_t bit_pos)
1097 {
1098         if (bit_pos <= 31)
1099                 return 0;
1100         fprintf(stderr, "Invalid bit position %d (must be <= 31)\n", bit_pos);
1101         return 1;
1102 }
1103
1104 #define display_port_and_reg_off(port_id, reg_off) \
1105         printf("port %d PCI register at offset 0x%X: ", (port_id), (reg_off))
1106
1107 static inline void
1108 display_port_reg_value(portid_t port_id, uint32_t reg_off, uint32_t reg_v)
1109 {
1110         display_port_and_reg_off(port_id, (unsigned)reg_off);
1111         printf("0x%08X (%u)\n", (unsigned)reg_v, (unsigned)reg_v);
1112 }
1113
1114 void
1115 port_reg_bit_display(portid_t port_id, uint32_t reg_off, uint8_t bit_x)
1116 {
1117         uint32_t reg_v;
1118
1119
1120         if (port_id_is_invalid(port_id, ENABLED_WARN))
1121                 return;
1122         if (port_reg_off_is_invalid(port_id, reg_off))
1123                 return;
1124         if (reg_bit_pos_is_invalid(bit_x))
1125                 return;
1126         reg_v = port_id_pci_reg_read(port_id, reg_off);
1127         display_port_and_reg_off(port_id, (unsigned)reg_off);
1128         printf("bit %d=%d\n", bit_x, (int) ((reg_v & (1 << bit_x)) >> bit_x));
1129 }
1130
1131 void
1132 port_reg_bit_field_display(portid_t port_id, uint32_t reg_off,
1133                            uint8_t bit1_pos, uint8_t bit2_pos)
1134 {
1135         uint32_t reg_v;
1136         uint8_t  l_bit;
1137         uint8_t  h_bit;
1138
1139         if (port_id_is_invalid(port_id, ENABLED_WARN))
1140                 return;
1141         if (port_reg_off_is_invalid(port_id, reg_off))
1142                 return;
1143         if (reg_bit_pos_is_invalid(bit1_pos))
1144                 return;
1145         if (reg_bit_pos_is_invalid(bit2_pos))
1146                 return;
1147         if (bit1_pos > bit2_pos)
1148                 l_bit = bit2_pos, h_bit = bit1_pos;
1149         else
1150                 l_bit = bit1_pos, h_bit = bit2_pos;
1151
1152         reg_v = port_id_pci_reg_read(port_id, reg_off);
1153         reg_v >>= l_bit;
1154         if (h_bit < 31)
1155                 reg_v &= ((1 << (h_bit - l_bit + 1)) - 1);
1156         display_port_and_reg_off(port_id, (unsigned)reg_off);
1157         printf("bits[%d, %d]=0x%0*X (%u)\n", l_bit, h_bit,
1158                ((h_bit - l_bit) / 4) + 1, (unsigned)reg_v, (unsigned)reg_v);
1159 }
1160
1161 void
1162 port_reg_display(portid_t port_id, uint32_t reg_off)
1163 {
1164         uint32_t reg_v;
1165
1166         if (port_id_is_invalid(port_id, ENABLED_WARN))
1167                 return;
1168         if (port_reg_off_is_invalid(port_id, reg_off))
1169                 return;
1170         reg_v = port_id_pci_reg_read(port_id, reg_off);
1171         display_port_reg_value(port_id, reg_off, reg_v);
1172 }
1173
1174 void
1175 port_reg_bit_set(portid_t port_id, uint32_t reg_off, uint8_t bit_pos,
1176                  uint8_t bit_v)
1177 {
1178         uint32_t reg_v;
1179
1180         if (port_id_is_invalid(port_id, ENABLED_WARN))
1181                 return;
1182         if (port_reg_off_is_invalid(port_id, reg_off))
1183                 return;
1184         if (reg_bit_pos_is_invalid(bit_pos))
1185                 return;
1186         if (bit_v > 1) {
1187                 fprintf(stderr, "Invalid bit value %d (must be 0 or 1)\n",
1188                         (int) bit_v);
1189                 return;
1190         }
1191         reg_v = port_id_pci_reg_read(port_id, reg_off);
1192         if (bit_v == 0)
1193                 reg_v &= ~(1 << bit_pos);
1194         else
1195                 reg_v |= (1 << bit_pos);
1196         port_id_pci_reg_write(port_id, reg_off, reg_v);
1197         display_port_reg_value(port_id, reg_off, reg_v);
1198 }
1199
1200 void
1201 port_reg_bit_field_set(portid_t port_id, uint32_t reg_off,
1202                        uint8_t bit1_pos, uint8_t bit2_pos, uint32_t value)
1203 {
1204         uint32_t max_v;
1205         uint32_t reg_v;
1206         uint8_t  l_bit;
1207         uint8_t  h_bit;
1208
1209         if (port_id_is_invalid(port_id, ENABLED_WARN))
1210                 return;
1211         if (port_reg_off_is_invalid(port_id, reg_off))
1212                 return;
1213         if (reg_bit_pos_is_invalid(bit1_pos))
1214                 return;
1215         if (reg_bit_pos_is_invalid(bit2_pos))
1216                 return;
1217         if (bit1_pos > bit2_pos)
1218                 l_bit = bit2_pos, h_bit = bit1_pos;
1219         else
1220                 l_bit = bit1_pos, h_bit = bit2_pos;
1221
1222         if ((h_bit - l_bit) < 31)
1223                 max_v = (1 << (h_bit - l_bit + 1)) - 1;
1224         else
1225                 max_v = 0xFFFFFFFF;
1226
1227         if (value > max_v) {
1228                 fprintf(stderr, "Invalid value %u (0x%x) must be < %u (0x%x)\n",
1229                                 (unsigned)value, (unsigned)value,
1230                                 (unsigned)max_v, (unsigned)max_v);
1231                 return;
1232         }
1233         reg_v = port_id_pci_reg_read(port_id, reg_off);
1234         reg_v &= ~(max_v << l_bit); /* Keep unchanged bits */
1235         reg_v |= (value << l_bit); /* Set changed bits */
1236         port_id_pci_reg_write(port_id, reg_off, reg_v);
1237         display_port_reg_value(port_id, reg_off, reg_v);
1238 }
1239
1240 void
1241 port_reg_set(portid_t port_id, uint32_t reg_off, uint32_t reg_v)
1242 {
1243         if (port_id_is_invalid(port_id, ENABLED_WARN))
1244                 return;
1245         if (port_reg_off_is_invalid(port_id, reg_off))
1246                 return;
1247         port_id_pci_reg_write(port_id, reg_off, reg_v);
1248         display_port_reg_value(port_id, reg_off, reg_v);
1249 }
1250
1251 void
1252 port_mtu_set(portid_t port_id, uint16_t mtu)
1253 {
1254         struct rte_port *port = &ports[port_id];
1255         int diag;
1256
1257         if (port_id_is_invalid(port_id, ENABLED_WARN))
1258                 return;
1259
1260         if (port->need_reconfig == 0) {
1261                 diag = rte_eth_dev_set_mtu(port_id, mtu);
1262                 if (diag != 0) {
1263                         fprintf(stderr, "Set MTU failed. diag=%d\n", diag);
1264                         return;
1265                 }
1266         }
1267
1268         port->dev_conf.rxmode.mtu = mtu;
1269 }
1270
1271 /* Generic flow management functions. */
1272
1273 static struct port_flow_tunnel *
1274 port_flow_locate_tunnel_id(struct rte_port *port, uint32_t port_tunnel_id)
1275 {
1276         struct port_flow_tunnel *flow_tunnel;
1277
1278         LIST_FOREACH(flow_tunnel, &port->flow_tunnel_list, chain) {
1279                 if (flow_tunnel->id == port_tunnel_id)
1280                         goto out;
1281         }
1282         flow_tunnel = NULL;
1283
1284 out:
1285         return flow_tunnel;
1286 }
1287
1288 const char *
1289 port_flow_tunnel_type(struct rte_flow_tunnel *tunnel)
1290 {
1291         const char *type;
1292         switch (tunnel->type) {
1293         default:
1294                 type = "unknown";
1295                 break;
1296         case RTE_FLOW_ITEM_TYPE_VXLAN:
1297                 type = "vxlan";
1298                 break;
1299         case RTE_FLOW_ITEM_TYPE_GRE:
1300                 type = "gre";
1301                 break;
1302         case RTE_FLOW_ITEM_TYPE_NVGRE:
1303                 type = "nvgre";
1304                 break;
1305         case RTE_FLOW_ITEM_TYPE_GENEVE:
1306                 type = "geneve";
1307                 break;
1308         }
1309
1310         return type;
1311 }
1312
1313 struct port_flow_tunnel *
1314 port_flow_locate_tunnel(uint16_t port_id, struct rte_flow_tunnel *tun)
1315 {
1316         struct rte_port *port = &ports[port_id];
1317         struct port_flow_tunnel *flow_tunnel;
1318
1319         LIST_FOREACH(flow_tunnel, &port->flow_tunnel_list, chain) {
1320                 if (!memcmp(&flow_tunnel->tunnel, tun, sizeof(*tun)))
1321                         goto out;
1322         }
1323         flow_tunnel = NULL;
1324
1325 out:
1326         return flow_tunnel;
1327 }
1328
1329 void port_flow_tunnel_list(portid_t port_id)
1330 {
1331         struct rte_port *port = &ports[port_id];
1332         struct port_flow_tunnel *flt;
1333
1334         LIST_FOREACH(flt, &port->flow_tunnel_list, chain) {
1335                 printf("port %u tunnel #%u type=%s",
1336                         port_id, flt->id, port_flow_tunnel_type(&flt->tunnel));
1337                 if (flt->tunnel.tun_id)
1338                         printf(" id=%" PRIu64, flt->tunnel.tun_id);
1339                 printf("\n");
1340         }
1341 }
1342
1343 void port_flow_tunnel_destroy(portid_t port_id, uint32_t tunnel_id)
1344 {
1345         struct rte_port *port = &ports[port_id];
1346         struct port_flow_tunnel *flt;
1347
1348         LIST_FOREACH(flt, &port->flow_tunnel_list, chain) {
1349                 if (flt->id == tunnel_id)
1350                         break;
1351         }
1352         if (flt) {
1353                 LIST_REMOVE(flt, chain);
1354                 free(flt);
1355                 printf("port %u: flow tunnel #%u destroyed\n",
1356                         port_id, tunnel_id);
1357         }
1358 }
1359
1360 void port_flow_tunnel_create(portid_t port_id, const struct tunnel_ops *ops)
1361 {
1362         struct rte_port *port = &ports[port_id];
1363         enum rte_flow_item_type type;
1364         struct port_flow_tunnel *flt;
1365
1366         if (!strcmp(ops->type, "vxlan"))
1367                 type = RTE_FLOW_ITEM_TYPE_VXLAN;
1368         else if (!strcmp(ops->type, "gre"))
1369                 type = RTE_FLOW_ITEM_TYPE_GRE;
1370         else if (!strcmp(ops->type, "nvgre"))
1371                 type = RTE_FLOW_ITEM_TYPE_NVGRE;
1372         else if (!strcmp(ops->type, "geneve"))
1373                 type = RTE_FLOW_ITEM_TYPE_GENEVE;
1374         else {
1375                 fprintf(stderr, "cannot offload \"%s\" tunnel type\n",
1376                         ops->type);
1377                 return;
1378         }
1379         LIST_FOREACH(flt, &port->flow_tunnel_list, chain) {
1380                 if (flt->tunnel.type == type)
1381                         break;
1382         }
1383         if (!flt) {
1384                 flt = calloc(1, sizeof(*flt));
1385                 if (!flt) {
1386                         fprintf(stderr, "failed to allocate port flt object\n");
1387                         return;
1388                 }
1389                 flt->tunnel.type = type;
1390                 flt->id = LIST_EMPTY(&port->flow_tunnel_list) ? 1 :
1391                                   LIST_FIRST(&port->flow_tunnel_list)->id + 1;
1392                 LIST_INSERT_HEAD(&port->flow_tunnel_list, flt, chain);
1393         }
1394         printf("port %d: flow tunnel #%u type %s\n",
1395                 port_id, flt->id, ops->type);
1396 }
1397
1398 /** Generate a port_flow entry from attributes/pattern/actions. */
1399 static struct port_flow *
1400 port_flow_new(const struct rte_flow_attr *attr,
1401               const struct rte_flow_item *pattern,
1402               const struct rte_flow_action *actions,
1403               struct rte_flow_error *error)
1404 {
1405         const struct rte_flow_conv_rule rule = {
1406                 .attr_ro = attr,
1407                 .pattern_ro = pattern,
1408                 .actions_ro = actions,
1409         };
1410         struct port_flow *pf;
1411         int ret;
1412
1413         ret = rte_flow_conv(RTE_FLOW_CONV_OP_RULE, NULL, 0, &rule, error);
1414         if (ret < 0)
1415                 return NULL;
1416         pf = calloc(1, offsetof(struct port_flow, rule) + ret);
1417         if (!pf) {
1418                 rte_flow_error_set
1419                         (error, errno, RTE_FLOW_ERROR_TYPE_UNSPECIFIED, NULL,
1420                          "calloc() failed");
1421                 return NULL;
1422         }
1423         if (rte_flow_conv(RTE_FLOW_CONV_OP_RULE, &pf->rule, ret, &rule,
1424                           error) >= 0)
1425                 return pf;
1426         free(pf);
1427         return NULL;
1428 }
1429
1430 /** Print a message out of a flow error. */
1431 static int
1432 port_flow_complain(struct rte_flow_error *error)
1433 {
1434         static const char *const errstrlist[] = {
1435                 [RTE_FLOW_ERROR_TYPE_NONE] = "no error",
1436                 [RTE_FLOW_ERROR_TYPE_UNSPECIFIED] = "cause unspecified",
1437                 [RTE_FLOW_ERROR_TYPE_HANDLE] = "flow rule (handle)",
1438                 [RTE_FLOW_ERROR_TYPE_ATTR_GROUP] = "group field",
1439                 [RTE_FLOW_ERROR_TYPE_ATTR_PRIORITY] = "priority field",
1440                 [RTE_FLOW_ERROR_TYPE_ATTR_INGRESS] = "ingress field",
1441                 [RTE_FLOW_ERROR_TYPE_ATTR_EGRESS] = "egress field",
1442                 [RTE_FLOW_ERROR_TYPE_ATTR_TRANSFER] = "transfer field",
1443                 [RTE_FLOW_ERROR_TYPE_ATTR] = "attributes structure",
1444                 [RTE_FLOW_ERROR_TYPE_ITEM_NUM] = "pattern length",
1445                 [RTE_FLOW_ERROR_TYPE_ITEM_SPEC] = "item specification",
1446                 [RTE_FLOW_ERROR_TYPE_ITEM_LAST] = "item specification range",
1447                 [RTE_FLOW_ERROR_TYPE_ITEM_MASK] = "item specification mask",
1448                 [RTE_FLOW_ERROR_TYPE_ITEM] = "specific pattern item",
1449                 [RTE_FLOW_ERROR_TYPE_ACTION_NUM] = "number of actions",
1450                 [RTE_FLOW_ERROR_TYPE_ACTION_CONF] = "action configuration",
1451                 [RTE_FLOW_ERROR_TYPE_ACTION] = "specific action",
1452         };
1453         const char *errstr;
1454         char buf[32];
1455         int err = rte_errno;
1456
1457         if ((unsigned int)error->type >= RTE_DIM(errstrlist) ||
1458             !errstrlist[error->type])
1459                 errstr = "unknown type";
1460         else
1461                 errstr = errstrlist[error->type];
1462         fprintf(stderr, "%s(): Caught PMD error type %d (%s): %s%s: %s\n",
1463                 __func__, error->type, errstr,
1464                 error->cause ? (snprintf(buf, sizeof(buf), "cause: %p, ",
1465                                          error->cause), buf) : "",
1466                 error->message ? error->message : "(no stated reason)",
1467                 rte_strerror(err));
1468
1469         switch (error->type) {
1470         case RTE_FLOW_ERROR_TYPE_ATTR_TRANSFER:
1471                 fprintf(stderr, "The status suggests the use of \"transfer\" "
1472                                 "as the possible cause of the failure. Make "
1473                                 "sure that the flow in question and its "
1474                                 "indirect components (if any) are managed "
1475                                 "via \"transfer\" proxy port. Use command "
1476                                 "\"show port (port_id) flow transfer proxy\" "
1477                                 "to figure out the proxy port ID\n");
1478                 break;
1479         default:
1480                 break;
1481         }
1482
1483         return -err;
1484 }
1485
1486 static void
1487 rss_config_display(struct rte_flow_action_rss *rss_conf)
1488 {
1489         uint8_t i;
1490
1491         if (rss_conf == NULL) {
1492                 fprintf(stderr, "Invalid rule\n");
1493                 return;
1494         }
1495
1496         printf("RSS:\n"
1497                " queues:");
1498         if (rss_conf->queue_num == 0)
1499                 printf(" none");
1500         for (i = 0; i < rss_conf->queue_num; i++)
1501                 printf(" %d", rss_conf->queue[i]);
1502         printf("\n");
1503
1504         printf(" function: ");
1505         switch (rss_conf->func) {
1506         case RTE_ETH_HASH_FUNCTION_DEFAULT:
1507                 printf("default\n");
1508                 break;
1509         case RTE_ETH_HASH_FUNCTION_TOEPLITZ:
1510                 printf("toeplitz\n");
1511                 break;
1512         case RTE_ETH_HASH_FUNCTION_SIMPLE_XOR:
1513                 printf("simple_xor\n");
1514                 break;
1515         case RTE_ETH_HASH_FUNCTION_SYMMETRIC_TOEPLITZ:
1516                 printf("symmetric_toeplitz\n");
1517                 break;
1518         default:
1519                 printf("Unknown function\n");
1520                 return;
1521         }
1522
1523         printf(" types:\n");
1524         if (rss_conf->types == 0) {
1525                 printf("  none\n");
1526                 return;
1527         }
1528         for (i = 0; rss_type_table[i].str; i++) {
1529                 if ((rss_conf->types &
1530                     rss_type_table[i].rss_type) ==
1531                     rss_type_table[i].rss_type &&
1532                     rss_type_table[i].rss_type != 0)
1533                         printf("  %s\n", rss_type_table[i].str);
1534         }
1535 }
1536
1537 static struct port_indirect_action *
1538 action_get_by_id(portid_t port_id, uint32_t id)
1539 {
1540         struct rte_port *port;
1541         struct port_indirect_action **ppia;
1542         struct port_indirect_action *pia = NULL;
1543
1544         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
1545             port_id == (portid_t)RTE_PORT_ALL)
1546                 return NULL;
1547         port = &ports[port_id];
1548         ppia = &port->actions_list;
1549         while (*ppia) {
1550                 if ((*ppia)->id == id) {
1551                         pia = *ppia;
1552                         break;
1553                 }
1554                 ppia = &(*ppia)->next;
1555         }
1556         if (!pia)
1557                 fprintf(stderr,
1558                         "Failed to find indirect action #%u on port %u\n",
1559                         id, port_id);
1560         return pia;
1561 }
1562
1563 static int
1564 action_alloc(portid_t port_id, uint32_t id,
1565              struct port_indirect_action **action)
1566 {
1567         struct rte_port *port;
1568         struct port_indirect_action **ppia;
1569         struct port_indirect_action *pia = NULL;
1570
1571         *action = NULL;
1572         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
1573             port_id == (portid_t)RTE_PORT_ALL)
1574                 return -EINVAL;
1575         port = &ports[port_id];
1576         if (id == UINT32_MAX) {
1577                 /* taking first available ID */
1578                 if (port->actions_list) {
1579                         if (port->actions_list->id == UINT32_MAX - 1) {
1580                                 fprintf(stderr,
1581                                         "Highest indirect action ID is already assigned, delete it first\n");
1582                                 return -ENOMEM;
1583                         }
1584                         id = port->actions_list->id + 1;
1585                 } else {
1586                         id = 0;
1587                 }
1588         }
1589         pia = calloc(1, sizeof(*pia));
1590         if (!pia) {
1591                 fprintf(stderr,
1592                         "Allocation of port %u indirect action failed\n",
1593                         port_id);
1594                 return -ENOMEM;
1595         }
1596         ppia = &port->actions_list;
1597         while (*ppia && (*ppia)->id > id)
1598                 ppia = &(*ppia)->next;
1599         if (*ppia && (*ppia)->id == id) {
1600                 fprintf(stderr,
1601                         "Indirect action #%u is already assigned, delete it first\n",
1602                         id);
1603                 free(pia);
1604                 return -EINVAL;
1605         }
1606         pia->next = *ppia;
1607         pia->id = id;
1608         *ppia = pia;
1609         *action = pia;
1610         return 0;
1611 }
1612
1613 static int
1614 template_alloc(uint32_t id, struct port_template **template,
1615                struct port_template **list)
1616 {
1617         struct port_template *lst = *list;
1618         struct port_template **ppt;
1619         struct port_template *pt = NULL;
1620
1621         *template = NULL;
1622         if (id == UINT32_MAX) {
1623                 /* taking first available ID */
1624                 if (lst) {
1625                         if (lst->id == UINT32_MAX - 1) {
1626                                 printf("Highest template ID is already"
1627                                 " assigned, delete it first\n");
1628                                 return -ENOMEM;
1629                         }
1630                         id = lst->id + 1;
1631                 } else {
1632                         id = 0;
1633                 }
1634         }
1635         pt = calloc(1, sizeof(*pt));
1636         if (!pt) {
1637                 printf("Allocation of port template failed\n");
1638                 return -ENOMEM;
1639         }
1640         ppt = list;
1641         while (*ppt && (*ppt)->id > id)
1642                 ppt = &(*ppt)->next;
1643         if (*ppt && (*ppt)->id == id) {
1644                 printf("Template #%u is already assigned,"
1645                         " delete it first\n", id);
1646                 free(pt);
1647                 return -EINVAL;
1648         }
1649         pt->next = *ppt;
1650         pt->id = id;
1651         *ppt = pt;
1652         *template = pt;
1653         return 0;
1654 }
1655
1656 static int
1657 table_alloc(uint32_t id, struct port_table **table,
1658             struct port_table **list)
1659 {
1660         struct port_table *lst = *list;
1661         struct port_table **ppt;
1662         struct port_table *pt = NULL;
1663
1664         *table = NULL;
1665         if (id == UINT32_MAX) {
1666                 /* taking first available ID */
1667                 if (lst) {
1668                         if (lst->id == UINT32_MAX - 1) {
1669                                 printf("Highest table ID is already"
1670                                 " assigned, delete it first\n");
1671                                 return -ENOMEM;
1672                         }
1673                         id = lst->id + 1;
1674                 } else {
1675                         id = 0;
1676                 }
1677         }
1678         pt = calloc(1, sizeof(*pt));
1679         if (!pt) {
1680                 printf("Allocation of table failed\n");
1681                 return -ENOMEM;
1682         }
1683         ppt = list;
1684         while (*ppt && (*ppt)->id > id)
1685                 ppt = &(*ppt)->next;
1686         if (*ppt && (*ppt)->id == id) {
1687                 printf("Table #%u is already assigned,"
1688                         " delete it first\n", id);
1689                 free(pt);
1690                 return -EINVAL;
1691         }
1692         pt->next = *ppt;
1693         pt->id = id;
1694         *ppt = pt;
1695         *table = pt;
1696         return 0;
1697 }
1698
1699 /** Get info about flow management resources. */
1700 int
1701 port_flow_get_info(portid_t port_id)
1702 {
1703         struct rte_flow_port_info port_info;
1704         struct rte_flow_queue_info queue_info;
1705         struct rte_flow_error error;
1706
1707         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
1708             port_id == (portid_t)RTE_PORT_ALL)
1709                 return -EINVAL;
1710         /* Poisoning to make sure PMDs update it in case of error. */
1711         memset(&error, 0x99, sizeof(error));
1712         memset(&port_info, 0, sizeof(port_info));
1713         memset(&queue_info, 0, sizeof(queue_info));
1714         if (rte_flow_info_get(port_id, &port_info, &queue_info, &error))
1715                 return port_flow_complain(&error);
1716         printf("Flow engine resources on port %u:\n"
1717                "Number of queues: %d\n"
1718                    "Size of queues: %d\n"
1719                "Number of counters: %d\n"
1720                "Number of aging objects: %d\n"
1721                "Number of meter actions: %d\n",
1722                port_id, port_info.max_nb_queues,
1723                    queue_info.max_size,
1724                port_info.max_nb_counters,
1725                port_info.max_nb_aging_objects,
1726                port_info.max_nb_meters);
1727         return 0;
1728 }
1729
1730 /** Configure flow management resources. */
1731 int
1732 port_flow_configure(portid_t port_id,
1733         const struct rte_flow_port_attr *port_attr,
1734         uint16_t nb_queue,
1735         const struct rte_flow_queue_attr *queue_attr)
1736 {
1737         struct rte_port *port;
1738         struct rte_flow_error error;
1739         const struct rte_flow_queue_attr *attr_list[nb_queue];
1740         int std_queue;
1741
1742         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
1743             port_id == (portid_t)RTE_PORT_ALL)
1744                 return -EINVAL;
1745         port = &ports[port_id];
1746         port->queue_nb = nb_queue;
1747         port->queue_sz = queue_attr->size;
1748         for (std_queue = 0; std_queue < nb_queue; std_queue++)
1749                 attr_list[std_queue] = queue_attr;
1750         /* Poisoning to make sure PMDs update it in case of error. */
1751         memset(&error, 0x66, sizeof(error));
1752         if (rte_flow_configure(port_id, port_attr, nb_queue, attr_list, &error))
1753                 return port_flow_complain(&error);
1754         printf("Configure flows on port %u: "
1755                "number of queues %d with %d elements\n",
1756                port_id, nb_queue, queue_attr->size);
1757         return 0;
1758 }
1759
1760 /** Create indirect action */
1761 int
1762 port_action_handle_create(portid_t port_id, uint32_t id,
1763                           const struct rte_flow_indir_action_conf *conf,
1764                           const struct rte_flow_action *action)
1765 {
1766         struct port_indirect_action *pia;
1767         int ret;
1768         struct rte_flow_error error;
1769
1770         ret = action_alloc(port_id, id, &pia);
1771         if (ret)
1772                 return ret;
1773         if (action->type == RTE_FLOW_ACTION_TYPE_AGE) {
1774                 struct rte_flow_action_age *age =
1775                         (struct rte_flow_action_age *)(uintptr_t)(action->conf);
1776
1777                 pia->age_type = ACTION_AGE_CONTEXT_TYPE_INDIRECT_ACTION;
1778                 age->context = &pia->age_type;
1779         } else if (action->type == RTE_FLOW_ACTION_TYPE_CONNTRACK) {
1780                 struct rte_flow_action_conntrack *ct =
1781                 (struct rte_flow_action_conntrack *)(uintptr_t)(action->conf);
1782
1783                 memcpy(ct, &conntrack_context, sizeof(*ct));
1784         }
1785         /* Poisoning to make sure PMDs update it in case of error. */
1786         memset(&error, 0x22, sizeof(error));
1787         pia->handle = rte_flow_action_handle_create(port_id, conf, action,
1788                                                     &error);
1789         if (!pia->handle) {
1790                 uint32_t destroy_id = pia->id;
1791                 port_action_handle_destroy(port_id, 1, &destroy_id);
1792                 return port_flow_complain(&error);
1793         }
1794         pia->type = action->type;
1795         printf("Indirect action #%u created\n", pia->id);
1796         return 0;
1797 }
1798
1799 /** Destroy indirect action */
1800 int
1801 port_action_handle_destroy(portid_t port_id,
1802                            uint32_t n,
1803                            const uint32_t *actions)
1804 {
1805         struct rte_port *port;
1806         struct port_indirect_action **tmp;
1807         uint32_t c = 0;
1808         int ret = 0;
1809
1810         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
1811             port_id == (portid_t)RTE_PORT_ALL)
1812                 return -EINVAL;
1813         port = &ports[port_id];
1814         tmp = &port->actions_list;
1815         while (*tmp) {
1816                 uint32_t i;
1817
1818                 for (i = 0; i != n; ++i) {
1819                         struct rte_flow_error error;
1820                         struct port_indirect_action *pia = *tmp;
1821
1822                         if (actions[i] != pia->id)
1823                                 continue;
1824                         /*
1825                          * Poisoning to make sure PMDs update it in case
1826                          * of error.
1827                          */
1828                         memset(&error, 0x33, sizeof(error));
1829
1830                         if (pia->handle && rte_flow_action_handle_destroy(
1831                                         port_id, pia->handle, &error)) {
1832                                 ret = port_flow_complain(&error);
1833                                 continue;
1834                         }
1835                         *tmp = pia->next;
1836                         printf("Indirect action #%u destroyed\n", pia->id);
1837                         free(pia);
1838                         break;
1839                 }
1840                 if (i == n)
1841                         tmp = &(*tmp)->next;
1842                 ++c;
1843         }
1844         return ret;
1845 }
1846
1847
1848 /** Get indirect action by port + id */
1849 struct rte_flow_action_handle *
1850 port_action_handle_get_by_id(portid_t port_id, uint32_t id)
1851 {
1852
1853         struct port_indirect_action *pia = action_get_by_id(port_id, id);
1854
1855         return (pia) ? pia->handle : NULL;
1856 }
1857
1858 /** Update indirect action */
1859 int
1860 port_action_handle_update(portid_t port_id, uint32_t id,
1861                           const struct rte_flow_action *action)
1862 {
1863         struct rte_flow_error error;
1864         struct rte_flow_action_handle *action_handle;
1865         struct port_indirect_action *pia;
1866         const void *update;
1867
1868         action_handle = port_action_handle_get_by_id(port_id, id);
1869         if (!action_handle)
1870                 return -EINVAL;
1871         pia = action_get_by_id(port_id, id);
1872         if (!pia)
1873                 return -EINVAL;
1874         switch (pia->type) {
1875         case RTE_FLOW_ACTION_TYPE_CONNTRACK:
1876                 update = action->conf;
1877                 break;
1878         default:
1879                 update = action;
1880                 break;
1881         }
1882         if (rte_flow_action_handle_update(port_id, action_handle, update,
1883                                           &error)) {
1884                 return port_flow_complain(&error);
1885         }
1886         printf("Indirect action #%u updated\n", id);
1887         return 0;
1888 }
1889
1890 int
1891 port_action_handle_query(portid_t port_id, uint32_t id)
1892 {
1893         struct rte_flow_error error;
1894         struct port_indirect_action *pia;
1895         union {
1896                 struct rte_flow_query_count count;
1897                 struct rte_flow_query_age age;
1898                 struct rte_flow_action_conntrack ct;
1899         } query;
1900
1901         pia = action_get_by_id(port_id, id);
1902         if (!pia)
1903                 return -EINVAL;
1904         switch (pia->type) {
1905         case RTE_FLOW_ACTION_TYPE_AGE:
1906         case RTE_FLOW_ACTION_TYPE_COUNT:
1907                 break;
1908         default:
1909                 fprintf(stderr,
1910                         "Indirect action %u (type: %d) on port %u doesn't support query\n",
1911                         id, pia->type, port_id);
1912                 return -ENOTSUP;
1913         }
1914         /* Poisoning to make sure PMDs update it in case of error. */
1915         memset(&error, 0x55, sizeof(error));
1916         memset(&query, 0, sizeof(query));
1917         if (rte_flow_action_handle_query(port_id, pia->handle, &query, &error))
1918                 return port_flow_complain(&error);
1919         switch (pia->type) {
1920         case RTE_FLOW_ACTION_TYPE_AGE:
1921                 printf("Indirect AGE action:\n"
1922                        " aged: %u\n"
1923                        " sec_since_last_hit_valid: %u\n"
1924                        " sec_since_last_hit: %" PRIu32 "\n",
1925                        query.age.aged,
1926                        query.age.sec_since_last_hit_valid,
1927                        query.age.sec_since_last_hit);
1928                 break;
1929         case RTE_FLOW_ACTION_TYPE_COUNT:
1930                 printf("Indirect COUNT action:\n"
1931                        " hits_set: %u\n"
1932                        " bytes_set: %u\n"
1933                        " hits: %" PRIu64 "\n"
1934                        " bytes: %" PRIu64 "\n",
1935                        query.count.hits_set,
1936                        query.count.bytes_set,
1937                        query.count.hits,
1938                        query.count.bytes);
1939                 break;
1940         case RTE_FLOW_ACTION_TYPE_CONNTRACK:
1941                 printf("Conntrack Context:\n"
1942                        "  Peer: %u, Flow dir: %s, Enable: %u\n"
1943                        "  Live: %u, SACK: %u, CACK: %u\n"
1944                        "  Packet dir: %s, Liberal: %u, State: %u\n"
1945                        "  Factor: %u, Retrans: %u, TCP flags: %u\n"
1946                        "  Last Seq: %u, Last ACK: %u\n"
1947                        "  Last Win: %u, Last End: %u\n",
1948                        query.ct.peer_port,
1949                        query.ct.is_original_dir ? "Original" : "Reply",
1950                        query.ct.enable, query.ct.live_connection,
1951                        query.ct.selective_ack, query.ct.challenge_ack_passed,
1952                        query.ct.last_direction ? "Original" : "Reply",
1953                        query.ct.liberal_mode, query.ct.state,
1954                        query.ct.max_ack_window, query.ct.retransmission_limit,
1955                        query.ct.last_index, query.ct.last_seq,
1956                        query.ct.last_ack, query.ct.last_window,
1957                        query.ct.last_end);
1958                 printf("  Original Dir:\n"
1959                        "    scale: %u, fin: %u, ack seen: %u\n"
1960                        " unacked data: %u\n    Sent end: %u,"
1961                        "    Reply end: %u, Max win: %u, Max ACK: %u\n",
1962                        query.ct.original_dir.scale,
1963                        query.ct.original_dir.close_initiated,
1964                        query.ct.original_dir.last_ack_seen,
1965                        query.ct.original_dir.data_unacked,
1966                        query.ct.original_dir.sent_end,
1967                        query.ct.original_dir.reply_end,
1968                        query.ct.original_dir.max_win,
1969                        query.ct.original_dir.max_ack);
1970                 printf("  Reply Dir:\n"
1971                        "    scale: %u, fin: %u, ack seen: %u\n"
1972                        " unacked data: %u\n    Sent end: %u,"
1973                        "    Reply end: %u, Max win: %u, Max ACK: %u\n",
1974                        query.ct.reply_dir.scale,
1975                        query.ct.reply_dir.close_initiated,
1976                        query.ct.reply_dir.last_ack_seen,
1977                        query.ct.reply_dir.data_unacked,
1978                        query.ct.reply_dir.sent_end,
1979                        query.ct.reply_dir.reply_end,
1980                        query.ct.reply_dir.max_win,
1981                        query.ct.reply_dir.max_ack);
1982                 break;
1983         default:
1984                 fprintf(stderr,
1985                         "Indirect action %u (type: %d) on port %u doesn't support query\n",
1986                         id, pia->type, port_id);
1987                 break;
1988         }
1989         return 0;
1990 }
1991
1992 static struct port_flow_tunnel *
1993 port_flow_tunnel_offload_cmd_prep(portid_t port_id,
1994                                   const struct rte_flow_item *pattern,
1995                                   const struct rte_flow_action *actions,
1996                                   const struct tunnel_ops *tunnel_ops)
1997 {
1998         int ret;
1999         struct rte_port *port;
2000         struct port_flow_tunnel *pft;
2001         struct rte_flow_error error;
2002
2003         port = &ports[port_id];
2004         pft = port_flow_locate_tunnel_id(port, tunnel_ops->id);
2005         if (!pft) {
2006                 fprintf(stderr, "failed to locate port flow tunnel #%u\n",
2007                         tunnel_ops->id);
2008                 return NULL;
2009         }
2010         if (tunnel_ops->actions) {
2011                 uint32_t num_actions;
2012                 const struct rte_flow_action *aptr;
2013
2014                 ret = rte_flow_tunnel_decap_set(port_id, &pft->tunnel,
2015                                                 &pft->pmd_actions,
2016                                                 &pft->num_pmd_actions,
2017                                                 &error);
2018                 if (ret) {
2019                         port_flow_complain(&error);
2020                         return NULL;
2021                 }
2022                 for (aptr = actions, num_actions = 1;
2023                      aptr->type != RTE_FLOW_ACTION_TYPE_END;
2024                      aptr++, num_actions++);
2025                 pft->actions = malloc(
2026                                 (num_actions +  pft->num_pmd_actions) *
2027                                 sizeof(actions[0]));
2028                 if (!pft->actions) {
2029                         rte_flow_tunnel_action_decap_release(
2030                                         port_id, pft->actions,
2031                                         pft->num_pmd_actions, &error);
2032                         return NULL;
2033                 }
2034                 rte_memcpy(pft->actions, pft->pmd_actions,
2035                            pft->num_pmd_actions * sizeof(actions[0]));
2036                 rte_memcpy(pft->actions + pft->num_pmd_actions, actions,
2037                            num_actions * sizeof(actions[0]));
2038         }
2039         if (tunnel_ops->items) {
2040                 uint32_t num_items;
2041                 const struct rte_flow_item *iptr;
2042
2043                 ret = rte_flow_tunnel_match(port_id, &pft->tunnel,
2044                                             &pft->pmd_items,
2045                                             &pft->num_pmd_items,
2046                                             &error);
2047                 if (ret) {
2048                         port_flow_complain(&error);
2049                         return NULL;
2050                 }
2051                 for (iptr = pattern, num_items = 1;
2052                      iptr->type != RTE_FLOW_ITEM_TYPE_END;
2053                      iptr++, num_items++);
2054                 pft->items = malloc((num_items + pft->num_pmd_items) *
2055                                     sizeof(pattern[0]));
2056                 if (!pft->items) {
2057                         rte_flow_tunnel_item_release(
2058                                         port_id, pft->pmd_items,
2059                                         pft->num_pmd_items, &error);
2060                         return NULL;
2061                 }
2062                 rte_memcpy(pft->items, pft->pmd_items,
2063                            pft->num_pmd_items * sizeof(pattern[0]));
2064                 rte_memcpy(pft->items + pft->num_pmd_items, pattern,
2065                            num_items * sizeof(pattern[0]));
2066         }
2067
2068         return pft;
2069 }
2070
2071 static void
2072 port_flow_tunnel_offload_cmd_release(portid_t port_id,
2073                                      const struct tunnel_ops *tunnel_ops,
2074                                      struct port_flow_tunnel *pft)
2075 {
2076         struct rte_flow_error error;
2077
2078         if (tunnel_ops->actions) {
2079                 free(pft->actions);
2080                 rte_flow_tunnel_action_decap_release(
2081                         port_id, pft->pmd_actions,
2082                         pft->num_pmd_actions, &error);
2083                 pft->actions = NULL;
2084                 pft->pmd_actions = NULL;
2085         }
2086         if (tunnel_ops->items) {
2087                 free(pft->items);
2088                 rte_flow_tunnel_item_release(port_id, pft->pmd_items,
2089                                              pft->num_pmd_items,
2090                                              &error);
2091                 pft->items = NULL;
2092                 pft->pmd_items = NULL;
2093         }
2094 }
2095
2096 /** Add port meter policy */
2097 int
2098 port_meter_policy_add(portid_t port_id, uint32_t policy_id,
2099                         const struct rte_flow_action *actions)
2100 {
2101         struct rte_mtr_error error;
2102         const struct rte_flow_action *act = actions;
2103         const struct rte_flow_action *start;
2104         struct rte_mtr_meter_policy_params policy;
2105         uint32_t i = 0, act_n;
2106         int ret;
2107
2108         for (i = 0; i < RTE_COLORS; i++) {
2109                 for (act_n = 0, start = act;
2110                         act->type != RTE_FLOW_ACTION_TYPE_END; act++)
2111                         act_n++;
2112                 if (act_n && act->type == RTE_FLOW_ACTION_TYPE_END)
2113                         policy.actions[i] = start;
2114                 else
2115                         policy.actions[i] = NULL;
2116                 act++;
2117         }
2118         ret = rte_mtr_meter_policy_add(port_id,
2119                         policy_id,
2120                         &policy, &error);
2121         if (ret)
2122                 print_mtr_err_msg(&error);
2123         return ret;
2124 }
2125
2126 /** Validate flow rule. */
2127 int
2128 port_flow_validate(portid_t port_id,
2129                    const struct rte_flow_attr *attr,
2130                    const struct rte_flow_item *pattern,
2131                    const struct rte_flow_action *actions,
2132                    const struct tunnel_ops *tunnel_ops)
2133 {
2134         struct rte_flow_error error;
2135         struct port_flow_tunnel *pft = NULL;
2136         int ret;
2137
2138         /* Poisoning to make sure PMDs update it in case of error. */
2139         memset(&error, 0x11, sizeof(error));
2140         if (tunnel_ops->enabled) {
2141                 pft = port_flow_tunnel_offload_cmd_prep(port_id, pattern,
2142                                                         actions, tunnel_ops);
2143                 if (!pft)
2144                         return -ENOENT;
2145                 if (pft->items)
2146                         pattern = pft->items;
2147                 if (pft->actions)
2148                         actions = pft->actions;
2149         }
2150         ret = rte_flow_validate(port_id, attr, pattern, actions, &error);
2151         if (tunnel_ops->enabled)
2152                 port_flow_tunnel_offload_cmd_release(port_id, tunnel_ops, pft);
2153         if (ret)
2154                 return port_flow_complain(&error);
2155         printf("Flow rule validated\n");
2156         return 0;
2157 }
2158
2159 /** Return age action structure if exists, otherwise NULL. */
2160 static struct rte_flow_action_age *
2161 age_action_get(const struct rte_flow_action *actions)
2162 {
2163         for (; actions->type != RTE_FLOW_ACTION_TYPE_END; actions++) {
2164                 switch (actions->type) {
2165                 case RTE_FLOW_ACTION_TYPE_AGE:
2166                         return (struct rte_flow_action_age *)
2167                                 (uintptr_t)actions->conf;
2168                 default:
2169                         break;
2170                 }
2171         }
2172         return NULL;
2173 }
2174
2175 /** Create pattern template */
2176 int
2177 port_flow_pattern_template_create(portid_t port_id, uint32_t id,
2178                                   const struct rte_flow_pattern_template_attr *attr,
2179                                   const struct rte_flow_item *pattern)
2180 {
2181         struct rte_port *port;
2182         struct port_template *pit;
2183         int ret;
2184         struct rte_flow_error error;
2185
2186         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2187             port_id == (portid_t)RTE_PORT_ALL)
2188                 return -EINVAL;
2189         port = &ports[port_id];
2190         ret = template_alloc(id, &pit, &port->pattern_templ_list);
2191         if (ret)
2192                 return ret;
2193         /* Poisoning to make sure PMDs update it in case of error. */
2194         memset(&error, 0x22, sizeof(error));
2195         pit->template.pattern_template = rte_flow_pattern_template_create(port_id,
2196                                                 attr, pattern, &error);
2197         if (!pit->template.pattern_template) {
2198                 uint32_t destroy_id = pit->id;
2199                 port_flow_pattern_template_destroy(port_id, 1, &destroy_id);
2200                 return port_flow_complain(&error);
2201         }
2202         printf("Pattern template #%u created\n", pit->id);
2203         return 0;
2204 }
2205
2206 /** Destroy pattern template */
2207 int
2208 port_flow_pattern_template_destroy(portid_t port_id, uint32_t n,
2209                                    const uint32_t *template)
2210 {
2211         struct rte_port *port;
2212         struct port_template **tmp;
2213         uint32_t c = 0;
2214         int ret = 0;
2215
2216         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2217             port_id == (portid_t)RTE_PORT_ALL)
2218                 return -EINVAL;
2219         port = &ports[port_id];
2220         tmp = &port->pattern_templ_list;
2221         while (*tmp) {
2222                 uint32_t i;
2223
2224                 for (i = 0; i != n; ++i) {
2225                         struct rte_flow_error error;
2226                         struct port_template *pit = *tmp;
2227
2228                         if (template[i] != pit->id)
2229                                 continue;
2230                         /*
2231                          * Poisoning to make sure PMDs update it in case
2232                          * of error.
2233                          */
2234                         memset(&error, 0x33, sizeof(error));
2235
2236                         if (pit->template.pattern_template &&
2237                             rte_flow_pattern_template_destroy(port_id,
2238                                                            pit->template.pattern_template,
2239                                                            &error)) {
2240                                 ret = port_flow_complain(&error);
2241                                 continue;
2242                         }
2243                         *tmp = pit->next;
2244                         printf("Pattern template #%u destroyed\n", pit->id);
2245                         free(pit);
2246                         break;
2247                 }
2248                 if (i == n)
2249                         tmp = &(*tmp)->next;
2250                 ++c;
2251         }
2252         return ret;
2253 }
2254
2255 /** Create actions template */
2256 int
2257 port_flow_actions_template_create(portid_t port_id, uint32_t id,
2258                                   const struct rte_flow_actions_template_attr *attr,
2259                                   const struct rte_flow_action *actions,
2260                                   const struct rte_flow_action *masks)
2261 {
2262         struct rte_port *port;
2263         struct port_template *pat;
2264         int ret;
2265         struct rte_flow_error error;
2266
2267         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2268             port_id == (portid_t)RTE_PORT_ALL)
2269                 return -EINVAL;
2270         port = &ports[port_id];
2271         ret = template_alloc(id, &pat, &port->actions_templ_list);
2272         if (ret)
2273                 return ret;
2274         /* Poisoning to make sure PMDs update it in case of error. */
2275         memset(&error, 0x22, sizeof(error));
2276         pat->template.actions_template = rte_flow_actions_template_create(port_id,
2277                                                 attr, actions, masks, &error);
2278         if (!pat->template.actions_template) {
2279                 uint32_t destroy_id = pat->id;
2280                 port_flow_actions_template_destroy(port_id, 1, &destroy_id);
2281                 return port_flow_complain(&error);
2282         }
2283         printf("Actions template #%u created\n", pat->id);
2284         return 0;
2285 }
2286
2287 /** Destroy actions template */
2288 int
2289 port_flow_actions_template_destroy(portid_t port_id, uint32_t n,
2290                                    const uint32_t *template)
2291 {
2292         struct rte_port *port;
2293         struct port_template **tmp;
2294         uint32_t c = 0;
2295         int ret = 0;
2296
2297         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2298             port_id == (portid_t)RTE_PORT_ALL)
2299                 return -EINVAL;
2300         port = &ports[port_id];
2301         tmp = &port->actions_templ_list;
2302         while (*tmp) {
2303                 uint32_t i;
2304
2305                 for (i = 0; i != n; ++i) {
2306                         struct rte_flow_error error;
2307                         struct port_template *pat = *tmp;
2308
2309                         if (template[i] != pat->id)
2310                                 continue;
2311                         /*
2312                          * Poisoning to make sure PMDs update it in case
2313                          * of error.
2314                          */
2315                         memset(&error, 0x33, sizeof(error));
2316
2317                         if (pat->template.actions_template &&
2318                             rte_flow_actions_template_destroy(port_id,
2319                                         pat->template.actions_template, &error)) {
2320                                 ret = port_flow_complain(&error);
2321                                 continue;
2322                         }
2323                         *tmp = pat->next;
2324                         printf("Actions template #%u destroyed\n", pat->id);
2325                         free(pat);
2326                         break;
2327                 }
2328                 if (i == n)
2329                         tmp = &(*tmp)->next;
2330                 ++c;
2331         }
2332         return ret;
2333 }
2334
2335 /** Create table */
2336 int
2337 port_flow_template_table_create(portid_t port_id, uint32_t id,
2338                 const struct rte_flow_template_table_attr *table_attr,
2339                 uint32_t nb_pattern_templates, uint32_t *pattern_templates,
2340                 uint32_t nb_actions_templates, uint32_t *actions_templates)
2341 {
2342         struct rte_port *port;
2343         struct port_table *pt;
2344         struct port_template *temp = NULL;
2345         int ret;
2346         uint32_t i;
2347         struct rte_flow_error error;
2348         struct rte_flow_pattern_template
2349                         *flow_pattern_templates[nb_pattern_templates];
2350         struct rte_flow_actions_template
2351                         *flow_actions_templates[nb_actions_templates];
2352
2353         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2354             port_id == (portid_t)RTE_PORT_ALL)
2355                 return -EINVAL;
2356         port = &ports[port_id];
2357         for (i = 0; i < nb_pattern_templates; ++i) {
2358                 bool found = false;
2359                 temp = port->pattern_templ_list;
2360                 while (temp) {
2361                         if (pattern_templates[i] == temp->id) {
2362                                 flow_pattern_templates[i] =
2363                                         temp->template.pattern_template;
2364                                 found = true;
2365                                 break;
2366                         }
2367                         temp = temp->next;
2368                 }
2369                 if (!found) {
2370                         printf("Pattern template #%u is invalid\n",
2371                                pattern_templates[i]);
2372                         return -EINVAL;
2373                 }
2374         }
2375         for (i = 0; i < nb_actions_templates; ++i) {
2376                 bool found = false;
2377                 temp = port->actions_templ_list;
2378                 while (temp) {
2379                         if (actions_templates[i] == temp->id) {
2380                                 flow_actions_templates[i] =
2381                                         temp->template.actions_template;
2382                                 found = true;
2383                                 break;
2384                         }
2385                         temp = temp->next;
2386                 }
2387                 if (!found) {
2388                         printf("Actions template #%u is invalid\n",
2389                                actions_templates[i]);
2390                         return -EINVAL;
2391                 }
2392         }
2393         ret = table_alloc(id, &pt, &port->table_list);
2394         if (ret)
2395                 return ret;
2396         /* Poisoning to make sure PMDs update it in case of error. */
2397         memset(&error, 0x22, sizeof(error));
2398         pt->table = rte_flow_template_table_create(port_id, table_attr,
2399                       flow_pattern_templates, nb_pattern_templates,
2400                       flow_actions_templates, nb_actions_templates,
2401                       &error);
2402
2403         if (!pt->table) {
2404                 uint32_t destroy_id = pt->id;
2405                 port_flow_template_table_destroy(port_id, 1, &destroy_id);
2406                 return port_flow_complain(&error);
2407         }
2408         pt->nb_pattern_templates = nb_pattern_templates;
2409         pt->nb_actions_templates = nb_actions_templates;
2410         printf("Template table #%u created\n", pt->id);
2411         return 0;
2412 }
2413
2414 /** Destroy table */
2415 int
2416 port_flow_template_table_destroy(portid_t port_id,
2417                                  uint32_t n, const uint32_t *table)
2418 {
2419         struct rte_port *port;
2420         struct port_table **tmp;
2421         uint32_t c = 0;
2422         int ret = 0;
2423
2424         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2425             port_id == (portid_t)RTE_PORT_ALL)
2426                 return -EINVAL;
2427         port = &ports[port_id];
2428         tmp = &port->table_list;
2429         while (*tmp) {
2430                 uint32_t i;
2431
2432                 for (i = 0; i != n; ++i) {
2433                         struct rte_flow_error error;
2434                         struct port_table *pt = *tmp;
2435
2436                         if (table[i] != pt->id)
2437                                 continue;
2438                         /*
2439                          * Poisoning to make sure PMDs update it in case
2440                          * of error.
2441                          */
2442                         memset(&error, 0x33, sizeof(error));
2443
2444                         if (pt->table &&
2445                             rte_flow_template_table_destroy(port_id,
2446                                                             pt->table,
2447                                                             &error)) {
2448                                 ret = port_flow_complain(&error);
2449                                 continue;
2450                         }
2451                         *tmp = pt->next;
2452                         printf("Template table #%u destroyed\n", pt->id);
2453                         free(pt);
2454                         break;
2455                 }
2456                 if (i == n)
2457                         tmp = &(*tmp)->next;
2458                 ++c;
2459         }
2460         return ret;
2461 }
2462
2463 /** Enqueue create flow rule operation. */
2464 int
2465 port_queue_flow_create(portid_t port_id, queueid_t queue_id,
2466                        bool postpone, uint32_t table_id,
2467                        uint32_t pattern_idx, uint32_t actions_idx,
2468                        const struct rte_flow_item *pattern,
2469                        const struct rte_flow_action *actions)
2470 {
2471         struct rte_flow_op_attr op_attr = { .postpone = postpone };
2472         struct rte_flow *flow;
2473         struct rte_port *port;
2474         struct port_flow *pf;
2475         struct port_table *pt;
2476         uint32_t id = 0;
2477         bool found;
2478         struct rte_flow_error error = { RTE_FLOW_ERROR_TYPE_NONE, NULL, NULL };
2479         struct rte_flow_action_age *age = age_action_get(actions);
2480
2481         port = &ports[port_id];
2482         if (port->flow_list) {
2483                 if (port->flow_list->id == UINT32_MAX) {
2484                         printf("Highest rule ID is already assigned,"
2485                                " delete it first");
2486                         return -ENOMEM;
2487                 }
2488                 id = port->flow_list->id + 1;
2489         }
2490
2491         if (queue_id >= port->queue_nb) {
2492                 printf("Queue #%u is invalid\n", queue_id);
2493                 return -EINVAL;
2494         }
2495
2496         found = false;
2497         pt = port->table_list;
2498         while (pt) {
2499                 if (table_id == pt->id) {
2500                         found = true;
2501                         break;
2502                 }
2503                 pt = pt->next;
2504         }
2505         if (!found) {
2506                 printf("Table #%u is invalid\n", table_id);
2507                 return -EINVAL;
2508         }
2509
2510         if (pattern_idx >= pt->nb_pattern_templates) {
2511                 printf("Pattern template index #%u is invalid,"
2512                        " %u templates present in the table\n",
2513                        pattern_idx, pt->nb_pattern_templates);
2514                 return -EINVAL;
2515         }
2516         if (actions_idx >= pt->nb_actions_templates) {
2517                 printf("Actions template index #%u is invalid,"
2518                        " %u templates present in the table\n",
2519                        actions_idx, pt->nb_actions_templates);
2520                 return -EINVAL;
2521         }
2522
2523         pf = port_flow_new(NULL, pattern, actions, &error);
2524         if (!pf)
2525                 return port_flow_complain(&error);
2526         if (age) {
2527                 pf->age_type = ACTION_AGE_CONTEXT_TYPE_FLOW;
2528                 age->context = &pf->age_type;
2529         }
2530         /* Poisoning to make sure PMDs update it in case of error. */
2531         memset(&error, 0x11, sizeof(error));
2532         flow = rte_flow_async_create(port_id, queue_id, &op_attr, pt->table,
2533                 pattern, pattern_idx, actions, actions_idx, NULL, &error);
2534         if (!flow) {
2535                 uint32_t flow_id = pf->id;
2536                 port_queue_flow_destroy(port_id, queue_id, true, 1, &flow_id);
2537                 return port_flow_complain(&error);
2538         }
2539
2540         pf->next = port->flow_list;
2541         pf->id = id;
2542         pf->flow = flow;
2543         port->flow_list = pf;
2544         printf("Flow rule #%u creation enqueued\n", pf->id);
2545         return 0;
2546 }
2547
2548 /** Enqueue number of destroy flow rules operations. */
2549 int
2550 port_queue_flow_destroy(portid_t port_id, queueid_t queue_id,
2551                         bool postpone, uint32_t n, const uint32_t *rule)
2552 {
2553         struct rte_flow_op_attr op_attr = { .postpone = postpone };
2554         struct rte_port *port;
2555         struct port_flow **tmp;
2556         uint32_t c = 0;
2557         int ret = 0;
2558
2559         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2560             port_id == (portid_t)RTE_PORT_ALL)
2561                 return -EINVAL;
2562         port = &ports[port_id];
2563
2564         if (queue_id >= port->queue_nb) {
2565                 printf("Queue #%u is invalid\n", queue_id);
2566                 return -EINVAL;
2567         }
2568
2569         tmp = &port->flow_list;
2570         while (*tmp) {
2571                 uint32_t i;
2572
2573                 for (i = 0; i != n; ++i) {
2574                         struct rte_flow_error error;
2575                         struct port_flow *pf = *tmp;
2576
2577                         if (rule[i] != pf->id)
2578                                 continue;
2579                         /*
2580                          * Poisoning to make sure PMD
2581                          * update it in case of error.
2582                          */
2583                         memset(&error, 0x33, sizeof(error));
2584                         if (rte_flow_async_destroy(port_id, queue_id, &op_attr,
2585                                                    pf->flow, NULL, &error)) {
2586                                 ret = port_flow_complain(&error);
2587                                 continue;
2588                         }
2589                         printf("Flow rule #%u destruction enqueued\n", pf->id);
2590                         *tmp = pf->next;
2591                         free(pf);
2592                         break;
2593                 }
2594                 if (i == n)
2595                         tmp = &(*tmp)->next;
2596                 ++c;
2597         }
2598         return ret;
2599 }
2600
2601 /** Push all the queue operations in the queue to the NIC. */
2602 int
2603 port_queue_flow_push(portid_t port_id, queueid_t queue_id)
2604 {
2605         struct rte_port *port;
2606         struct rte_flow_error error;
2607         int ret = 0;
2608
2609         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2610             port_id == (portid_t)RTE_PORT_ALL)
2611                 return -EINVAL;
2612         port = &ports[port_id];
2613
2614         if (queue_id >= port->queue_nb) {
2615                 printf("Queue #%u is invalid\n", queue_id);
2616                 return -EINVAL;
2617         }
2618
2619         memset(&error, 0x55, sizeof(error));
2620         ret = rte_flow_push(port_id, queue_id, &error);
2621         if (ret < 0) {
2622                 printf("Failed to push operations in the queue\n");
2623                 return -EINVAL;
2624         }
2625         printf("Queue #%u operations pushed\n", queue_id);
2626         return ret;
2627 }
2628
2629 /** Pull queue operation results from the queue. */
2630 int
2631 port_queue_flow_pull(portid_t port_id, queueid_t queue_id)
2632 {
2633         struct rte_port *port;
2634         struct rte_flow_op_result *res;
2635         struct rte_flow_error error;
2636         int ret = 0;
2637         int success = 0;
2638         int i;
2639
2640         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2641             port_id == (portid_t)RTE_PORT_ALL)
2642                 return -EINVAL;
2643         port = &ports[port_id];
2644
2645         if (queue_id >= port->queue_nb) {
2646                 printf("Queue #%u is invalid\n", queue_id);
2647                 return -EINVAL;
2648         }
2649
2650         res = calloc(port->queue_sz, sizeof(struct rte_flow_op_result));
2651         if (!res) {
2652                 printf("Failed to allocate memory for pulled results\n");
2653                 return -ENOMEM;
2654         }
2655
2656         memset(&error, 0x66, sizeof(error));
2657         ret = rte_flow_pull(port_id, queue_id, res,
2658                                  port->queue_sz, &error);
2659         if (ret < 0) {
2660                 printf("Failed to pull a operation results\n");
2661                 free(res);
2662                 return -EINVAL;
2663         }
2664
2665         for (i = 0; i < ret; i++) {
2666                 if (res[i].status == RTE_FLOW_OP_SUCCESS)
2667                         success++;
2668         }
2669         printf("Queue #%u pulled %u operations (%u failed, %u succeeded)\n",
2670                queue_id, ret, ret - success, success);
2671         free(res);
2672         return ret;
2673 }
2674
2675 /** Create flow rule. */
2676 int
2677 port_flow_create(portid_t port_id,
2678                  const struct rte_flow_attr *attr,
2679                  const struct rte_flow_item *pattern,
2680                  const struct rte_flow_action *actions,
2681                  const struct tunnel_ops *tunnel_ops)
2682 {
2683         struct rte_flow *flow;
2684         struct rte_port *port;
2685         struct port_flow *pf;
2686         uint32_t id = 0;
2687         struct rte_flow_error error;
2688         struct port_flow_tunnel *pft = NULL;
2689         struct rte_flow_action_age *age = age_action_get(actions);
2690
2691         port = &ports[port_id];
2692         if (port->flow_list) {
2693                 if (port->flow_list->id == UINT32_MAX) {
2694                         fprintf(stderr,
2695                                 "Highest rule ID is already assigned, delete it first");
2696                         return -ENOMEM;
2697                 }
2698                 id = port->flow_list->id + 1;
2699         }
2700         if (tunnel_ops->enabled) {
2701                 pft = port_flow_tunnel_offload_cmd_prep(port_id, pattern,
2702                                                         actions, tunnel_ops);
2703                 if (!pft)
2704                         return -ENOENT;
2705                 if (pft->items)
2706                         pattern = pft->items;
2707                 if (pft->actions)
2708                         actions = pft->actions;
2709         }
2710         pf = port_flow_new(attr, pattern, actions, &error);
2711         if (!pf)
2712                 return port_flow_complain(&error);
2713         if (age) {
2714                 pf->age_type = ACTION_AGE_CONTEXT_TYPE_FLOW;
2715                 age->context = &pf->age_type;
2716         }
2717         /* Poisoning to make sure PMDs update it in case of error. */
2718         memset(&error, 0x22, sizeof(error));
2719         flow = rte_flow_create(port_id, attr, pattern, actions, &error);
2720         if (!flow) {
2721                 if (tunnel_ops->enabled)
2722                         port_flow_tunnel_offload_cmd_release(port_id,
2723                                                              tunnel_ops, pft);
2724                 free(pf);
2725                 return port_flow_complain(&error);
2726         }
2727         pf->next = port->flow_list;
2728         pf->id = id;
2729         pf->flow = flow;
2730         port->flow_list = pf;
2731         if (tunnel_ops->enabled)
2732                 port_flow_tunnel_offload_cmd_release(port_id, tunnel_ops, pft);
2733         printf("Flow rule #%u created\n", pf->id);
2734         return 0;
2735 }
2736
2737 /** Destroy a number of flow rules. */
2738 int
2739 port_flow_destroy(portid_t port_id, uint32_t n, const uint32_t *rule)
2740 {
2741         struct rte_port *port;
2742         struct port_flow **tmp;
2743         uint32_t c = 0;
2744         int ret = 0;
2745
2746         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2747             port_id == (portid_t)RTE_PORT_ALL)
2748                 return -EINVAL;
2749         port = &ports[port_id];
2750         tmp = &port->flow_list;
2751         while (*tmp) {
2752                 uint32_t i;
2753
2754                 for (i = 0; i != n; ++i) {
2755                         struct rte_flow_error error;
2756                         struct port_flow *pf = *tmp;
2757
2758                         if (rule[i] != pf->id)
2759                                 continue;
2760                         /*
2761                          * Poisoning to make sure PMDs update it in case
2762                          * of error.
2763                          */
2764                         memset(&error, 0x33, sizeof(error));
2765                         if (rte_flow_destroy(port_id, pf->flow, &error)) {
2766                                 ret = port_flow_complain(&error);
2767                                 continue;
2768                         }
2769                         printf("Flow rule #%u destroyed\n", pf->id);
2770                         *tmp = pf->next;
2771                         free(pf);
2772                         break;
2773                 }
2774                 if (i == n)
2775                         tmp = &(*tmp)->next;
2776                 ++c;
2777         }
2778         return ret;
2779 }
2780
2781 /** Remove all flow rules. */
2782 int
2783 port_flow_flush(portid_t port_id)
2784 {
2785         struct rte_flow_error error;
2786         struct rte_port *port;
2787         int ret = 0;
2788
2789         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2790                 port_id == (portid_t)RTE_PORT_ALL)
2791                 return -EINVAL;
2792
2793         port = &ports[port_id];
2794
2795         if (port->flow_list == NULL)
2796                 return ret;
2797
2798         /* Poisoning to make sure PMDs update it in case of error. */
2799         memset(&error, 0x44, sizeof(error));
2800         if (rte_flow_flush(port_id, &error)) {
2801                 port_flow_complain(&error);
2802         }
2803
2804         while (port->flow_list) {
2805                 struct port_flow *pf = port->flow_list->next;
2806
2807                 free(port->flow_list);
2808                 port->flow_list = pf;
2809         }
2810         return ret;
2811 }
2812
2813 /** Dump flow rules. */
2814 int
2815 port_flow_dump(portid_t port_id, bool dump_all, uint32_t rule_id,
2816                 const char *file_name)
2817 {
2818         int ret = 0;
2819         FILE *file = stdout;
2820         struct rte_flow_error error;
2821         struct rte_port *port;
2822         struct port_flow *pflow;
2823         struct rte_flow *tmpFlow = NULL;
2824         bool found = false;
2825
2826         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2827                 port_id == (portid_t)RTE_PORT_ALL)
2828                 return -EINVAL;
2829
2830         if (!dump_all) {
2831                 port = &ports[port_id];
2832                 pflow = port->flow_list;
2833                 while (pflow) {
2834                         if (rule_id != pflow->id) {
2835                                 pflow = pflow->next;
2836                         } else {
2837                                 tmpFlow = pflow->flow;
2838                                 if (tmpFlow)
2839                                         found = true;
2840                                 break;
2841                         }
2842                 }
2843                 if (found == false) {
2844                         fprintf(stderr, "Failed to dump to flow %d\n", rule_id);
2845                         return -EINVAL;
2846                 }
2847         }
2848
2849         if (file_name && strlen(file_name)) {
2850                 file = fopen(file_name, "w");
2851                 if (!file) {
2852                         fprintf(stderr, "Failed to create file %s: %s\n",
2853                                 file_name, strerror(errno));
2854                         return -errno;
2855                 }
2856         }
2857
2858         if (!dump_all)
2859                 ret = rte_flow_dev_dump(port_id, tmpFlow, file, &error);
2860         else
2861                 ret = rte_flow_dev_dump(port_id, NULL, file, &error);
2862         if (ret) {
2863                 port_flow_complain(&error);
2864                 fprintf(stderr, "Failed to dump flow: %s\n", strerror(-ret));
2865         } else
2866                 printf("Flow dump finished\n");
2867         if (file_name && strlen(file_name))
2868                 fclose(file);
2869         return ret;
2870 }
2871
2872 /** Query a flow rule. */
2873 int
2874 port_flow_query(portid_t port_id, uint32_t rule,
2875                 const struct rte_flow_action *action)
2876 {
2877         struct rte_flow_error error;
2878         struct rte_port *port;
2879         struct port_flow *pf;
2880         const char *name;
2881         union {
2882                 struct rte_flow_query_count count;
2883                 struct rte_flow_action_rss rss_conf;
2884                 struct rte_flow_query_age age;
2885         } query;
2886         int ret;
2887
2888         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2889             port_id == (portid_t)RTE_PORT_ALL)
2890                 return -EINVAL;
2891         port = &ports[port_id];
2892         for (pf = port->flow_list; pf; pf = pf->next)
2893                 if (pf->id == rule)
2894                         break;
2895         if (!pf) {
2896                 fprintf(stderr, "Flow rule #%u not found\n", rule);
2897                 return -ENOENT;
2898         }
2899         ret = rte_flow_conv(RTE_FLOW_CONV_OP_ACTION_NAME_PTR,
2900                             &name, sizeof(name),
2901                             (void *)(uintptr_t)action->type, &error);
2902         if (ret < 0)
2903                 return port_flow_complain(&error);
2904         switch (action->type) {
2905         case RTE_FLOW_ACTION_TYPE_COUNT:
2906         case RTE_FLOW_ACTION_TYPE_RSS:
2907         case RTE_FLOW_ACTION_TYPE_AGE:
2908                 break;
2909         default:
2910                 fprintf(stderr, "Cannot query action type %d (%s)\n",
2911                         action->type, name);
2912                 return -ENOTSUP;
2913         }
2914         /* Poisoning to make sure PMDs update it in case of error. */
2915         memset(&error, 0x55, sizeof(error));
2916         memset(&query, 0, sizeof(query));
2917         if (rte_flow_query(port_id, pf->flow, action, &query, &error))
2918                 return port_flow_complain(&error);
2919         switch (action->type) {
2920         case RTE_FLOW_ACTION_TYPE_COUNT:
2921                 printf("%s:\n"
2922                        " hits_set: %u\n"
2923                        " bytes_set: %u\n"
2924                        " hits: %" PRIu64 "\n"
2925                        " bytes: %" PRIu64 "\n",
2926                        name,
2927                        query.count.hits_set,
2928                        query.count.bytes_set,
2929                        query.count.hits,
2930                        query.count.bytes);
2931                 break;
2932         case RTE_FLOW_ACTION_TYPE_RSS:
2933                 rss_config_display(&query.rss_conf);
2934                 break;
2935         case RTE_FLOW_ACTION_TYPE_AGE:
2936                 printf("%s:\n"
2937                        " aged: %u\n"
2938                        " sec_since_last_hit_valid: %u\n"
2939                        " sec_since_last_hit: %" PRIu32 "\n",
2940                        name,
2941                        query.age.aged,
2942                        query.age.sec_since_last_hit_valid,
2943                        query.age.sec_since_last_hit);
2944                 break;
2945         default:
2946                 fprintf(stderr,
2947                         "Cannot display result for action type %d (%s)\n",
2948                         action->type, name);
2949                 break;
2950         }
2951         return 0;
2952 }
2953
2954 /** List simply and destroy all aged flows. */
2955 void
2956 port_flow_aged(portid_t port_id, uint8_t destroy)
2957 {
2958         void **contexts;
2959         int nb_context, total = 0, idx;
2960         struct rte_flow_error error;
2961         enum age_action_context_type *type;
2962         union {
2963                 struct port_flow *pf;
2964                 struct port_indirect_action *pia;
2965         } ctx;
2966
2967         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
2968             port_id == (portid_t)RTE_PORT_ALL)
2969                 return;
2970         total = rte_flow_get_aged_flows(port_id, NULL, 0, &error);
2971         printf("Port %u total aged flows: %d\n", port_id, total);
2972         if (total < 0) {
2973                 port_flow_complain(&error);
2974                 return;
2975         }
2976         if (total == 0)
2977                 return;
2978         contexts = malloc(sizeof(void *) * total);
2979         if (contexts == NULL) {
2980                 fprintf(stderr, "Cannot allocate contexts for aged flow\n");
2981                 return;
2982         }
2983         printf("%-20s\tID\tGroup\tPrio\tAttr\n", "Type");
2984         nb_context = rte_flow_get_aged_flows(port_id, contexts, total, &error);
2985         if (nb_context != total) {
2986                 fprintf(stderr,
2987                         "Port:%d get aged flows count(%d) != total(%d)\n",
2988                         port_id, nb_context, total);
2989                 free(contexts);
2990                 return;
2991         }
2992         total = 0;
2993         for (idx = 0; idx < nb_context; idx++) {
2994                 if (!contexts[idx]) {
2995                         fprintf(stderr, "Error: get Null context in port %u\n",
2996                                 port_id);
2997                         continue;
2998                 }
2999                 type = (enum age_action_context_type *)contexts[idx];
3000                 switch (*type) {
3001                 case ACTION_AGE_CONTEXT_TYPE_FLOW:
3002                         ctx.pf = container_of(type, struct port_flow, age_type);
3003                         printf("%-20s\t%" PRIu32 "\t%" PRIu32 "\t%" PRIu32
3004                                                                  "\t%c%c%c\t\n",
3005                                "Flow",
3006                                ctx.pf->id,
3007                                ctx.pf->rule.attr->group,
3008                                ctx.pf->rule.attr->priority,
3009                                ctx.pf->rule.attr->ingress ? 'i' : '-',
3010                                ctx.pf->rule.attr->egress ? 'e' : '-',
3011                                ctx.pf->rule.attr->transfer ? 't' : '-');
3012                         if (destroy && !port_flow_destroy(port_id, 1,
3013                                                           &ctx.pf->id))
3014                                 total++;
3015                         break;
3016                 case ACTION_AGE_CONTEXT_TYPE_INDIRECT_ACTION:
3017                         ctx.pia = container_of(type,
3018                                         struct port_indirect_action, age_type);
3019                         printf("%-20s\t%" PRIu32 "\n", "Indirect action",
3020                                ctx.pia->id);
3021                         break;
3022                 default:
3023                         fprintf(stderr, "Error: invalid context type %u\n",
3024                                 port_id);
3025                         break;
3026                 }
3027         }
3028         printf("\n%d flows destroyed\n", total);
3029         free(contexts);
3030 }
3031
3032 /** List flow rules. */
3033 void
3034 port_flow_list(portid_t port_id, uint32_t n, const uint32_t *group)
3035 {
3036         struct rte_port *port;
3037         struct port_flow *pf;
3038         struct port_flow *list = NULL;
3039         uint32_t i;
3040
3041         if (port_id_is_invalid(port_id, ENABLED_WARN) ||
3042             port_id == (portid_t)RTE_PORT_ALL)
3043                 return;
3044         port = &ports[port_id];
3045         if (!port->flow_list)
3046                 return;
3047         /* Sort flows by group, priority and ID. */
3048         for (pf = port->flow_list; pf != NULL; pf = pf->next) {
3049                 struct port_flow **tmp;
3050                 const struct rte_flow_attr *curr = pf->rule.attr;
3051
3052                 if (n) {
3053                         /* Filter out unwanted groups. */
3054                         for (i = 0; i != n; ++i)
3055                                 if (curr->group == group[i])
3056                                         break;
3057                         if (i == n)
3058                                 continue;
3059                 }
3060                 for (tmp = &list; *tmp; tmp = &(*tmp)->tmp) {
3061                         const struct rte_flow_attr *comp = (*tmp)->rule.attr;
3062
3063                         if (curr->group > comp->group ||
3064                             (curr->group == comp->group &&
3065                              curr->priority > comp->priority) ||
3066                             (curr->group == comp->group &&
3067                              curr->priority == comp->priority &&
3068                              pf->id > (*tmp)->id))
3069                                 continue;
3070                         break;
3071                 }
3072                 pf->tmp = *tmp;
3073                 *tmp = pf;
3074         }
3075         printf("ID\tGroup\tPrio\tAttr\tRule\n");
3076         for (pf = list; pf != NULL; pf = pf->tmp) {
3077                 const struct rte_flow_item *item = pf->rule.pattern;
3078                 const struct rte_flow_action *action = pf->rule.actions;
3079                 const char *name;
3080
3081                 printf("%" PRIu32 "\t%" PRIu32 "\t%" PRIu32 "\t%c%c%c\t",
3082                        pf->id,
3083                        pf->rule.attr->group,
3084                        pf->rule.attr->priority,
3085                        pf->rule.attr->ingress ? 'i' : '-',
3086                        pf->rule.attr->egress ? 'e' : '-',
3087                        pf->rule.attr->transfer ? 't' : '-');
3088                 while (item->type != RTE_FLOW_ITEM_TYPE_END) {
3089                         if ((uint32_t)item->type > INT_MAX)
3090                                 name = "PMD_INTERNAL";
3091                         else if (rte_flow_conv(RTE_FLOW_CONV_OP_ITEM_NAME_PTR,
3092                                           &name, sizeof(name),
3093                                           (void *)(uintptr_t)item->type,
3094                                           NULL) <= 0)
3095                                 name = "[UNKNOWN]";
3096                         if (item->type != RTE_FLOW_ITEM_TYPE_VOID)
3097                                 printf("%s ", name);
3098                         ++item;
3099                 }
3100                 printf("=>");
3101                 while (action->type != RTE_FLOW_ACTION_TYPE_END) {
3102                         if ((uint32_t)action->type > INT_MAX)
3103                                 name = "PMD_INTERNAL";
3104                         else if (rte_flow_conv(RTE_FLOW_CONV_OP_ACTION_NAME_PTR,
3105                                           &name, sizeof(name),
3106                                           (void *)(uintptr_t)action->type,
3107                                           NULL) <= 0)
3108                                 name = "[UNKNOWN]";
3109                         if (action->type != RTE_FLOW_ACTION_TYPE_VOID)
3110                                 printf(" %s", name);
3111                         ++action;
3112                 }
3113                 printf("\n");
3114         }
3115 }
3116
3117 /** Restrict ingress traffic to the defined flow rules. */
3118 int
3119 port_flow_isolate(portid_t port_id, int set)
3120 {
3121         struct rte_flow_error error;
3122
3123         /* Poisoning to make sure PMDs update it in case of error. */
3124         memset(&error, 0x66, sizeof(error));
3125         if (rte_flow_isolate(port_id, set, &error))
3126                 return port_flow_complain(&error);
3127         printf("Ingress traffic on port %u is %s to the defined flow rules\n",
3128                port_id,
3129                set ? "now restricted" : "not restricted anymore");
3130         return 0;
3131 }
3132
3133 /*
3134  * RX/TX ring descriptors display functions.
3135  */
3136 int
3137 rx_queue_id_is_invalid(queueid_t rxq_id)
3138 {
3139         if (rxq_id < nb_rxq)
3140                 return 0;
3141         fprintf(stderr, "Invalid RX queue %d (must be < nb_rxq=%d)\n",
3142                 rxq_id, nb_rxq);
3143         return 1;
3144 }
3145
3146 int
3147 tx_queue_id_is_invalid(queueid_t txq_id)
3148 {
3149         if (txq_id < nb_txq)
3150                 return 0;
3151         fprintf(stderr, "Invalid TX queue %d (must be < nb_txq=%d)\n",
3152                 txq_id, nb_txq);
3153         return 1;
3154 }
3155
3156 static int
3157 get_rx_ring_size(portid_t port_id, queueid_t rxq_id, uint16_t *ring_size)
3158 {
3159         struct rte_port *port = &ports[port_id];
3160         struct rte_eth_rxq_info rx_qinfo;
3161         int ret;
3162
3163         ret = rte_eth_rx_queue_info_get(port_id, rxq_id, &rx_qinfo);
3164         if (ret == 0) {
3165                 *ring_size = rx_qinfo.nb_desc;
3166                 return ret;
3167         }
3168
3169         if (ret != -ENOTSUP)
3170                 return ret;
3171         /*
3172          * If the rte_eth_rx_queue_info_get is not support for this PMD,
3173          * ring_size stored in testpmd will be used for validity verification.
3174          * When configure the rxq by rte_eth_rx_queue_setup with nb_rx_desc
3175          * being 0, it will use a default value provided by PMDs to setup this
3176          * rxq. If the default value is 0, it will use the
3177          * RTE_ETH_DEV_FALLBACK_RX_RINGSIZE to setup this rxq.
3178          */
3179         if (port->nb_rx_desc[rxq_id])
3180                 *ring_size = port->nb_rx_desc[rxq_id];
3181         else if (port->dev_info.default_rxportconf.ring_size)
3182                 *ring_size = port->dev_info.default_rxportconf.ring_size;
3183         else
3184                 *ring_size = RTE_ETH_DEV_FALLBACK_RX_RINGSIZE;
3185         return 0;
3186 }
3187
3188 static int
3189 get_tx_ring_size(portid_t port_id, queueid_t txq_id, uint16_t *ring_size)
3190 {
3191         struct rte_port *port = &ports[port_id];
3192         struct rte_eth_txq_info tx_qinfo;
3193         int ret;
3194
3195         ret = rte_eth_tx_queue_info_get(port_id, txq_id, &tx_qinfo);
3196         if (ret == 0) {
3197                 *ring_size = tx_qinfo.nb_desc;
3198                 return ret;
3199         }
3200
3201         if (ret != -ENOTSUP)
3202                 return ret;
3203         /*
3204          * If the rte_eth_tx_queue_info_get is not support for this PMD,
3205          * ring_size stored in testpmd will be used for validity verification.
3206          * When configure the txq by rte_eth_tx_queue_setup with nb_tx_desc
3207          * being 0, it will use a default value provided by PMDs to setup this
3208          * txq. If the default value is 0, it will use the
3209          * RTE_ETH_DEV_FALLBACK_TX_RINGSIZE to setup this txq.
3210          */
3211         if (port->nb_tx_desc[txq_id])
3212                 *ring_size = port->nb_tx_desc[txq_id];
3213         else if (port->dev_info.default_txportconf.ring_size)
3214                 *ring_size = port->dev_info.default_txportconf.ring_size;
3215         else
3216                 *ring_size = RTE_ETH_DEV_FALLBACK_TX_RINGSIZE;
3217         return 0;
3218 }
3219
3220 static int
3221 rx_desc_id_is_invalid(portid_t port_id, queueid_t rxq_id, uint16_t rxdesc_id)
3222 {
3223         uint16_t ring_size;
3224         int ret;
3225
3226         ret = get_rx_ring_size(port_id, rxq_id, &ring_size);
3227         if (ret)
3228                 return 1;
3229
3230         if (rxdesc_id < ring_size)
3231                 return 0;
3232
3233         fprintf(stderr, "Invalid RX descriptor %u (must be < ring_size=%u)\n",
3234                 rxdesc_id, ring_size);
3235         return 1;
3236 }
3237
3238 static int
3239 tx_desc_id_is_invalid(portid_t port_id, queueid_t txq_id, uint16_t txdesc_id)
3240 {
3241         uint16_t ring_size;
3242         int ret;
3243
3244         ret = get_tx_ring_size(port_id, txq_id, &ring_size);
3245         if (ret)
3246                 return 1;
3247
3248         if (txdesc_id < ring_size)
3249                 return 0;
3250
3251         fprintf(stderr, "Invalid TX descriptor %u (must be < ring_size=%u)\n",
3252                 txdesc_id, ring_size);
3253         return 1;
3254 }
3255
3256 static const struct rte_memzone *
3257 ring_dma_zone_lookup(const char *ring_name, portid_t port_id, uint16_t q_id)
3258 {
3259         char mz_name[RTE_MEMZONE_NAMESIZE];
3260         const struct rte_memzone *mz;
3261
3262         snprintf(mz_name, sizeof(mz_name), "eth_p%d_q%d_%s",
3263                         port_id, q_id, ring_name);
3264         mz = rte_memzone_lookup(mz_name);
3265         if (mz == NULL)
3266                 fprintf(stderr,
3267                         "%s ring memory zoneof (port %d, queue %d) not found (zone name = %s\n",
3268                         ring_name, port_id, q_id, mz_name);
3269         return mz;
3270 }
3271
3272 union igb_ring_dword {
3273         uint64_t dword;
3274         struct {
3275 #if RTE_BYTE_ORDER == RTE_BIG_ENDIAN
3276                 uint32_t lo;
3277                 uint32_t hi;
3278 #else
3279                 uint32_t hi;
3280                 uint32_t lo;
3281 #endif
3282         } words;
3283 };
3284
3285 struct igb_ring_desc_32_bytes {
3286         union igb_ring_dword lo_dword;
3287         union igb_ring_dword hi_dword;
3288         union igb_ring_dword resv1;
3289         union igb_ring_dword resv2;
3290 };
3291
3292 struct igb_ring_desc_16_bytes {
3293         union igb_ring_dword lo_dword;
3294         union igb_ring_dword hi_dword;
3295 };
3296
3297 static void
3298 ring_rxd_display_dword(union igb_ring_dword dword)
3299 {
3300         printf("    0x%08X - 0x%08X\n", (unsigned)dword.words.lo,
3301                                         (unsigned)dword.words.hi);
3302 }
3303
3304 static void
3305 ring_rx_descriptor_display(const struct rte_memzone *ring_mz,
3306 #ifndef RTE_LIBRTE_I40E_16BYTE_RX_DESC
3307                            portid_t port_id,
3308 #else
3309                            __rte_unused portid_t port_id,
3310 #endif
3311                            uint16_t desc_id)
3312 {
3313         struct igb_ring_desc_16_bytes *ring =
3314                 (struct igb_ring_desc_16_bytes *)ring_mz->addr;
3315 #ifndef RTE_LIBRTE_I40E_16BYTE_RX_DESC
3316         int ret;
3317         struct rte_eth_dev_info dev_info;
3318
3319         ret = eth_dev_info_get_print_err(port_id, &dev_info);
3320         if (ret != 0)
3321                 return;
3322
3323         if (strstr(dev_info.driver_name, "i40e") != NULL) {
3324                 /* 32 bytes RX descriptor, i40e only */
3325                 struct igb_ring_desc_32_bytes *ring =
3326                         (struct igb_ring_desc_32_bytes *)ring_mz->addr;
3327                 ring[desc_id].lo_dword.dword =
3328                         rte_le_to_cpu_64(ring[desc_id].lo_dword.dword);
3329                 ring_rxd_display_dword(ring[desc_id].lo_dword);
3330                 ring[desc_id].hi_dword.dword =
3331                         rte_le_to_cpu_64(ring[desc_id].hi_dword.dword);
3332                 ring_rxd_display_dword(ring[desc_id].hi_dword);
3333                 ring[desc_id].resv1.dword =
3334                         rte_le_to_cpu_64(ring[desc_id].resv1.dword);
3335                 ring_rxd_display_dword(ring[desc_id].resv1);
3336                 ring[desc_id].resv2.dword =
3337                         rte_le_to_cpu_64(ring[desc_id].resv2.dword);
3338                 ring_rxd_display_dword(ring[desc_id].resv2);
3339
3340                 return;
3341         }
3342 #endif
3343         /* 16 bytes RX descriptor */
3344         ring[desc_id].lo_dword.dword =
3345                 rte_le_to_cpu_64(ring[desc_id].lo_dword.dword);
3346         ring_rxd_display_dword(ring[desc_id].lo_dword);
3347         ring[desc_id].hi_dword.dword =
3348                 rte_le_to_cpu_64(ring[desc_id].hi_dword.dword);
3349         ring_rxd_display_dword(ring[desc_id].hi_dword);
3350 }
3351
3352 static void
3353 ring_tx_descriptor_display(const struct rte_memzone *ring_mz, uint16_t desc_id)
3354 {
3355         struct igb_ring_desc_16_bytes *ring;
3356         struct igb_ring_desc_16_bytes txd;
3357
3358         ring = (struct igb_ring_desc_16_bytes *)ring_mz->addr;
3359         txd.lo_dword.dword = rte_le_to_cpu_64(ring[desc_id].lo_dword.dword);
3360         txd.hi_dword.dword = rte_le_to_cpu_64(ring[desc_id].hi_dword.dword);
3361         printf("    0x%08X - 0x%08X / 0x%08X - 0x%08X\n",
3362                         (unsigned)txd.lo_dword.words.lo,
3363                         (unsigned)txd.lo_dword.words.hi,
3364                         (unsigned)txd.hi_dword.words.lo,
3365                         (unsigned)txd.hi_dword.words.hi);
3366 }
3367
3368 void
3369 rx_ring_desc_display(portid_t port_id, queueid_t rxq_id, uint16_t rxd_id)
3370 {
3371         const struct rte_memzone *rx_mz;
3372
3373         if (rx_desc_id_is_invalid(port_id, rxq_id, rxd_id))
3374                 return;
3375         rx_mz = ring_dma_zone_lookup("rx_ring", port_id, rxq_id);
3376         if (rx_mz == NULL)
3377                 return;
3378         ring_rx_descriptor_display(rx_mz, port_id, rxd_id);
3379 }
3380
3381 void
3382 tx_ring_desc_display(portid_t port_id, queueid_t txq_id, uint16_t txd_id)
3383 {
3384         const struct rte_memzone *tx_mz;
3385
3386         if (tx_desc_id_is_invalid(port_id, txq_id, txd_id))
3387                 return;
3388         tx_mz = ring_dma_zone_lookup("tx_ring", port_id, txq_id);
3389         if (tx_mz == NULL)
3390                 return;
3391         ring_tx_descriptor_display(tx_mz, txd_id);
3392 }
3393
3394 void
3395 fwd_lcores_config_display(void)
3396 {
3397         lcoreid_t lc_id;
3398
3399         printf("List of forwarding lcores:");
3400         for (lc_id = 0; lc_id < nb_cfg_lcores; lc_id++)
3401                 printf(" %2u", fwd_lcores_cpuids[lc_id]);
3402         printf("\n");
3403 }
3404 void
3405 rxtx_config_display(void)
3406 {
3407         portid_t pid;
3408         queueid_t qid;
3409
3410         printf("  %s packet forwarding%s packets/burst=%d\n",
3411                cur_fwd_eng->fwd_mode_name,
3412                retry_enabled == 0 ? "" : " with retry",
3413                nb_pkt_per_burst);
3414
3415         if (cur_fwd_eng == &tx_only_engine || cur_fwd_eng == &flow_gen_engine)
3416                 printf("  packet len=%u - nb packet segments=%d\n",
3417                                 (unsigned)tx_pkt_length, (int) tx_pkt_nb_segs);
3418
3419         printf("  nb forwarding cores=%d - nb forwarding ports=%d\n",
3420                nb_fwd_lcores, nb_fwd_ports);
3421
3422         RTE_ETH_FOREACH_DEV(pid) {
3423                 struct rte_eth_rxconf *rx_conf = &ports[pid].rx_conf[0];
3424                 struct rte_eth_txconf *tx_conf = &ports[pid].tx_conf[0];
3425                 uint16_t *nb_rx_desc = &ports[pid].nb_rx_desc[0];
3426                 uint16_t *nb_tx_desc = &ports[pid].nb_tx_desc[0];
3427                 struct rte_eth_rxq_info rx_qinfo;
3428                 struct rte_eth_txq_info tx_qinfo;
3429                 uint16_t rx_free_thresh_tmp;
3430                 uint16_t tx_free_thresh_tmp;
3431                 uint16_t tx_rs_thresh_tmp;
3432                 uint16_t nb_rx_desc_tmp;
3433                 uint16_t nb_tx_desc_tmp;
3434                 uint64_t offloads_tmp;
3435                 uint8_t pthresh_tmp;
3436                 uint8_t hthresh_tmp;
3437                 uint8_t wthresh_tmp;
3438                 int32_t rc;
3439
3440                 /* per port config */
3441                 printf("  port %d: RX queue number: %d Tx queue number: %d\n",
3442                                 (unsigned int)pid, nb_rxq, nb_txq);
3443
3444                 printf("    Rx offloads=0x%"PRIx64" Tx offloads=0x%"PRIx64"\n",
3445                                 ports[pid].dev_conf.rxmode.offloads,
3446                                 ports[pid].dev_conf.txmode.offloads);
3447
3448                 /* per rx queue config only for first queue to be less verbose */
3449                 for (qid = 0; qid < 1; qid++) {
3450                         rc = rte_eth_rx_queue_info_get(pid, qid, &rx_qinfo);
3451                         if (rc) {
3452                                 nb_rx_desc_tmp = nb_rx_desc[qid];
3453                                 rx_free_thresh_tmp =
3454                                         rx_conf[qid].rx_free_thresh;
3455                                 pthresh_tmp = rx_conf[qid].rx_thresh.pthresh;
3456                                 hthresh_tmp = rx_conf[qid].rx_thresh.hthresh;
3457                                 wthresh_tmp = rx_conf[qid].rx_thresh.wthresh;
3458                                 offloads_tmp = rx_conf[qid].offloads;
3459                         } else {
3460                                 nb_rx_desc_tmp = rx_qinfo.nb_desc;
3461                                 rx_free_thresh_tmp =
3462                                                 rx_qinfo.conf.rx_free_thresh;
3463                                 pthresh_tmp = rx_qinfo.conf.rx_thresh.pthresh;
3464                                 hthresh_tmp = rx_qinfo.conf.rx_thresh.hthresh;
3465                                 wthresh_tmp = rx_qinfo.conf.rx_thresh.wthresh;
3466                                 offloads_tmp = rx_qinfo.conf.offloads;
3467                         }
3468
3469                         printf("    RX queue: %d\n", qid);
3470                         printf("      RX desc=%d - RX free threshold=%d\n",
3471                                 nb_rx_desc_tmp, rx_free_thresh_tmp);
3472                         printf("      RX threshold registers: pthresh=%d hthresh=%d "
3473                                 " wthresh=%d\n",
3474                                 pthresh_tmp, hthresh_tmp, wthresh_tmp);
3475                         printf("      RX Offloads=0x%"PRIx64, offloads_tmp);
3476                         if (rx_conf->share_group > 0)
3477                                 printf(" share_group=%u share_qid=%u",
3478                                        rx_conf->share_group,
3479                                        rx_conf->share_qid);
3480                         printf("\n");
3481                 }
3482
3483                 /* per tx queue config only for first queue to be less verbose */
3484                 for (qid = 0; qid < 1; qid++) {
3485                         rc = rte_eth_tx_queue_info_get(pid, qid, &tx_qinfo);
3486                         if (rc) {
3487                                 nb_tx_desc_tmp = nb_tx_desc[qid];
3488                                 tx_free_thresh_tmp =
3489                                         tx_conf[qid].tx_free_thresh;
3490                                 pthresh_tmp = tx_conf[qid].tx_thresh.pthresh;
3491                                 hthresh_tmp = tx_conf[qid].tx_thresh.hthresh;
3492                                 wthresh_tmp = tx_conf[qid].tx_thresh.wthresh;
3493                                 offloads_tmp = tx_conf[qid].offloads;
3494                                 tx_rs_thresh_tmp = tx_conf[qid].tx_rs_thresh;
3495                         } else {
3496                                 nb_tx_desc_tmp = tx_qinfo.nb_desc;
3497                                 tx_free_thresh_tmp =
3498                                                 tx_qinfo.conf.tx_free_thresh;
3499                                 pthresh_tmp = tx_qinfo.conf.tx_thresh.pthresh;
3500                                 hthresh_tmp = tx_qinfo.conf.tx_thresh.hthresh;
3501                                 wthresh_tmp = tx_qinfo.conf.tx_thresh.wthresh;
3502                                 offloads_tmp = tx_qinfo.conf.offloads;
3503                                 tx_rs_thresh_tmp = tx_qinfo.conf.tx_rs_thresh;
3504                         }
3505
3506                         printf("    TX queue: %d\n", qid);
3507                         printf("      TX desc=%d - TX free threshold=%d\n",
3508                                 nb_tx_desc_tmp, tx_free_thresh_tmp);
3509                         printf("      TX threshold registers: pthresh=%d hthresh=%d "
3510                                 " wthresh=%d\n",
3511                                 pthresh_tmp, hthresh_tmp, wthresh_tmp);
3512                         printf("      TX offloads=0x%"PRIx64" - TX RS bit threshold=%d\n",
3513                                 offloads_tmp, tx_rs_thresh_tmp);
3514                 }
3515         }
3516 }
3517
3518 void
3519 port_rss_reta_info(portid_t port_id,
3520                    struct rte_eth_rss_reta_entry64 *reta_conf,
3521                    uint16_t nb_entries)
3522 {
3523         uint16_t i, idx, shift;
3524         int ret;
3525
3526         if (port_id_is_invalid(port_id, ENABLED_WARN))
3527                 return;
3528
3529         ret = rte_eth_dev_rss_reta_query(port_id, reta_conf, nb_entries);
3530         if (ret != 0) {
3531                 fprintf(stderr,
3532                         "Failed to get RSS RETA info, return code = %d\n",
3533                         ret);
3534                 return;
3535         }
3536
3537         for (i = 0; i < nb_entries; i++) {
3538                 idx = i / RTE_ETH_RETA_GROUP_SIZE;
3539                 shift = i % RTE_ETH_RETA_GROUP_SIZE;
3540                 if (!(reta_conf[idx].mask & (1ULL << shift)))
3541                         continue;
3542                 printf("RSS RETA configuration: hash index=%u, queue=%u\n",
3543                                         i, reta_conf[idx].reta[shift]);
3544         }
3545 }
3546
3547 /*
3548  * Displays the RSS hash functions of a port, and, optionally, the RSS hash
3549  * key of the port.
3550  */
3551 void
3552 port_rss_hash_conf_show(portid_t port_id, int show_rss_key)
3553 {
3554         struct rte_eth_rss_conf rss_conf = {0};
3555         uint8_t rss_key[RSS_HASH_KEY_LENGTH];
3556         uint64_t rss_hf;
3557         uint8_t i;
3558         int diag;
3559         struct rte_eth_dev_info dev_info;
3560         uint8_t hash_key_size;
3561         int ret;
3562
3563         if (port_id_is_invalid(port_id, ENABLED_WARN))
3564                 return;
3565
3566         ret = eth_dev_info_get_print_err(port_id, &dev_info);
3567         if (ret != 0)
3568                 return;
3569
3570         if (dev_info.hash_key_size > 0 &&
3571                         dev_info.hash_key_size <= sizeof(rss_key))
3572                 hash_key_size = dev_info.hash_key_size;
3573         else {
3574                 fprintf(stderr,
3575                         "dev_info did not provide a valid hash key size\n");
3576                 return;
3577         }
3578
3579         /* Get RSS hash key if asked to display it */
3580         rss_conf.rss_key = (show_rss_key) ? rss_key : NULL;
3581         rss_conf.rss_key_len = hash_key_size;
3582         diag = rte_eth_dev_rss_hash_conf_get(port_id, &rss_conf);
3583         if (diag != 0) {
3584                 switch (diag) {
3585                 case -ENODEV:
3586                         fprintf(stderr, "port index %d invalid\n", port_id);
3587                         break;
3588                 case -ENOTSUP:
3589                         fprintf(stderr, "operation not supported by device\n");
3590                         break;
3591                 default:
3592                         fprintf(stderr, "operation failed - diag=%d\n", diag);
3593                         break;
3594                 }
3595                 return;
3596         }
3597         rss_hf = rss_conf.rss_hf;
3598         if (rss_hf == 0) {
3599                 printf("RSS disabled\n");
3600                 return;
3601         }
3602         printf("RSS functions:\n ");
3603         for (i = 0; rss_type_table[i].str; i++) {
3604                 if (rss_type_table[i].rss_type == 0)
3605                         continue;
3606                 if ((rss_hf & rss_type_table[i].rss_type) == rss_type_table[i].rss_type)
3607                         printf("%s ", rss_type_table[i].str);
3608         }
3609         printf("\n");
3610         if (!show_rss_key)
3611                 return;
3612         printf("RSS key:\n");
3613         for (i = 0; i < hash_key_size; i++)
3614                 printf("%02X", rss_key[i]);
3615         printf("\n");
3616 }
3617
3618 void
3619 port_rss_hash_key_update(portid_t port_id, char rss_type[], uint8_t *hash_key,
3620                          uint8_t hash_key_len)
3621 {
3622         struct rte_eth_rss_conf rss_conf;
3623         int diag;
3624         unsigned int i;
3625
3626         rss_conf.rss_key = NULL;
3627         rss_conf.rss_key_len = 0;
3628         rss_conf.rss_hf = 0;
3629         for (i = 0; rss_type_table[i].str; i++) {
3630                 if (!strcmp(rss_type_table[i].str, rss_type))
3631                         rss_conf.rss_hf = rss_type_table[i].rss_type;
3632         }
3633         diag = rte_eth_dev_rss_hash_conf_get(port_id, &rss_conf);
3634         if (diag == 0) {
3635                 rss_conf.rss_key = hash_key;
3636                 rss_conf.rss_key_len = hash_key_len;
3637                 diag = rte_eth_dev_rss_hash_update(port_id, &rss_conf);
3638         }
3639         if (diag == 0)
3640                 return;
3641
3642         switch (diag) {
3643         case -ENODEV:
3644                 fprintf(stderr, "port index %d invalid\n", port_id);
3645                 break;
3646         case -ENOTSUP:
3647                 fprintf(stderr, "operation not supported by device\n");
3648                 break;
3649         default:
3650                 fprintf(stderr, "operation failed - diag=%d\n", diag);
3651                 break;
3652         }
3653 }
3654
3655 /*
3656  * Check whether a shared rxq scheduled on other lcores.
3657  */
3658 static bool
3659 fwd_stream_on_other_lcores(uint16_t domain_id, lcoreid_t src_lc,
3660                            portid_t src_port, queueid_t src_rxq,
3661                            uint32_t share_group, queueid_t share_rxq)
3662 {
3663         streamid_t sm_id;
3664         streamid_t nb_fs_per_lcore;
3665         lcoreid_t  nb_fc;
3666         lcoreid_t  lc_id;
3667         struct fwd_stream *fs;
3668         struct rte_port *port;
3669         struct rte_eth_dev_info *dev_info;
3670         struct rte_eth_rxconf *rxq_conf;
3671
3672         nb_fc = cur_fwd_config.nb_fwd_lcores;
3673         /* Check remaining cores. */
3674         for (lc_id = src_lc + 1; lc_id < nb_fc; lc_id++) {
3675                 sm_id = fwd_lcores[lc_id]->stream_idx;
3676                 nb_fs_per_lcore = fwd_lcores[lc_id]->stream_nb;
3677                 for (; sm_id < fwd_lcores[lc_id]->stream_idx + nb_fs_per_lcore;
3678                      sm_id++) {
3679                         fs = fwd_streams[sm_id];
3680                         port = &ports[fs->rx_port];
3681                         dev_info = &port->dev_info;
3682                         rxq_conf = &port->rx_conf[fs->rx_queue];
3683                         if ((dev_info->dev_capa & RTE_ETH_DEV_CAPA_RXQ_SHARE)
3684                             == 0 || rxq_conf->share_group == 0)
3685                                 /* Not shared rxq. */
3686                                 continue;
3687                         if (domain_id != port->dev_info.switch_info.domain_id)
3688                                 continue;
3689                         if (rxq_conf->share_group != share_group)
3690                                 continue;
3691                         if (rxq_conf->share_qid != share_rxq)
3692                                 continue;
3693                         printf("Shared Rx queue group %u queue %hu can't be scheduled on different cores:\n",
3694                                share_group, share_rxq);
3695                         printf("  lcore %hhu Port %hu queue %hu\n",
3696                                src_lc, src_port, src_rxq);
3697                         printf("  lcore %hhu Port %hu queue %hu\n",
3698                                lc_id, fs->rx_port, fs->rx_queue);
3699                         printf("Please use --nb-cores=%hu to limit number of forwarding cores\n",
3700                                nb_rxq);
3701                         return true;
3702                 }
3703         }
3704         return false;
3705 }
3706
3707 /*
3708  * Check shared rxq configuration.
3709  *
3710  * Shared group must not being scheduled on different core.
3711  */
3712 bool
3713 pkt_fwd_shared_rxq_check(void)
3714 {
3715         streamid_t sm_id;
3716         streamid_t nb_fs_per_lcore;
3717         lcoreid_t  nb_fc;
3718         lcoreid_t  lc_id;
3719         struct fwd_stream *fs;
3720         uint16_t domain_id;
3721         struct rte_port *port;
3722         struct rte_eth_dev_info *dev_info;
3723         struct rte_eth_rxconf *rxq_conf;
3724
3725         if (rxq_share == 0)
3726                 return true;
3727         nb_fc = cur_fwd_config.nb_fwd_lcores;
3728         /*
3729          * Check streams on each core, make sure the same switch domain +
3730          * group + queue doesn't get scheduled on other cores.
3731          */
3732         for (lc_id = 0; lc_id < nb_fc; lc_id++) {
3733                 sm_id = fwd_lcores[lc_id]->stream_idx;
3734                 nb_fs_per_lcore = fwd_lcores[lc_id]->stream_nb;
3735                 for (; sm_id < fwd_lcores[lc_id]->stream_idx + nb_fs_per_lcore;
3736                      sm_id++) {
3737                         fs = fwd_streams[sm_id];
3738                         /* Update lcore info stream being scheduled. */
3739                         fs->lcore = fwd_lcores[lc_id];
3740                         port = &ports[fs->rx_port];
3741                         dev_info = &port->dev_info;
3742                         rxq_conf = &port->rx_conf[fs->rx_queue];
3743                         if ((dev_info->dev_capa & RTE_ETH_DEV_CAPA_RXQ_SHARE)
3744                             == 0 || rxq_conf->share_group == 0)
3745                                 /* Not shared rxq. */
3746                                 continue;
3747                         /* Check shared rxq not scheduled on remaining cores. */
3748                         domain_id = port->dev_info.switch_info.domain_id;
3749                         if (fwd_stream_on_other_lcores(domain_id, lc_id,
3750                                                        fs->rx_port,
3751                                                        fs->rx_queue,
3752                                                        rxq_conf->share_group,
3753                                                        rxq_conf->share_qid))
3754                                 return false;
3755                 }
3756         }
3757         return true;
3758 }
3759
3760 /*
3761  * Setup forwarding configuration for each logical core.
3762  */
3763 static void
3764 setup_fwd_config_of_each_lcore(struct fwd_config *cfg)
3765 {
3766         streamid_t nb_fs_per_lcore;
3767         streamid_t nb_fs;
3768         streamid_t sm_id;
3769         lcoreid_t  nb_extra;
3770         lcoreid_t  nb_fc;
3771         lcoreid_t  nb_lc;
3772         lcoreid_t  lc_id;
3773
3774         nb_fs = cfg->nb_fwd_streams;
3775         nb_fc = cfg->nb_fwd_lcores;
3776         if (nb_fs <= nb_fc) {
3777                 nb_fs_per_lcore = 1;
3778                 nb_extra = 0;
3779         } else {
3780                 nb_fs_per_lcore = (streamid_t) (nb_fs / nb_fc);
3781                 nb_extra = (lcoreid_t) (nb_fs % nb_fc);
3782         }
3783
3784         nb_lc = (lcoreid_t) (nb_fc - nb_extra);
3785         sm_id = 0;
3786         for (lc_id = 0; lc_id < nb_lc; lc_id++) {
3787                 fwd_lcores[lc_id]->stream_idx = sm_id;
3788                 fwd_lcores[lc_id]->stream_nb = nb_fs_per_lcore;
3789                 sm_id = (streamid_t) (sm_id + nb_fs_per_lcore);
3790         }
3791
3792         /*
3793          * Assign extra remaining streams, if any.
3794          */
3795         nb_fs_per_lcore = (streamid_t) (nb_fs_per_lcore + 1);
3796         for (lc_id = 0; lc_id < nb_extra; lc_id++) {
3797                 fwd_lcores[nb_lc + lc_id]->stream_idx = sm_id;
3798                 fwd_lcores[nb_lc + lc_id]->stream_nb = nb_fs_per_lcore;
3799                 sm_id = (streamid_t) (sm_id + nb_fs_per_lcore);
3800         }
3801 }
3802
3803 static portid_t
3804 fwd_topology_tx_port_get(portid_t rxp)
3805 {
3806         static int warning_once = 1;
3807
3808         RTE_ASSERT(rxp < cur_fwd_config.nb_fwd_ports);
3809
3810         switch (port_topology) {
3811         default:
3812         case PORT_TOPOLOGY_PAIRED:
3813                 if ((rxp & 0x1) == 0) {
3814                         if (rxp + 1 < cur_fwd_config.nb_fwd_ports)
3815                                 return rxp + 1;
3816                         if (warning_once) {
3817                                 fprintf(stderr,
3818                                         "\nWarning! port-topology=paired and odd forward ports number, the last port will pair with itself.\n\n");
3819                                 warning_once = 0;
3820                         }
3821                         return rxp;
3822                 }
3823                 return rxp - 1;
3824         case PORT_TOPOLOGY_CHAINED:
3825                 return (rxp + 1) % cur_fwd_config.nb_fwd_ports;
3826         case PORT_TOPOLOGY_LOOP:
3827                 return rxp;
3828         }
3829 }
3830
3831 static void
3832 simple_fwd_config_setup(void)
3833 {
3834         portid_t i;
3835
3836         cur_fwd_config.nb_fwd_ports = (portid_t) nb_fwd_ports;
3837         cur_fwd_config.nb_fwd_streams =
3838                 (streamid_t) cur_fwd_config.nb_fwd_ports;
3839
3840         /* reinitialize forwarding streams */
3841         init_fwd_streams();
3842
3843         /*
3844          * In the simple forwarding test, the number of forwarding cores
3845          * must be lower or equal to the number of forwarding ports.
3846          */
3847         cur_fwd_config.nb_fwd_lcores = (lcoreid_t) nb_fwd_lcores;
3848         if (cur_fwd_config.nb_fwd_lcores > cur_fwd_config.nb_fwd_ports)
3849                 cur_fwd_config.nb_fwd_lcores =
3850                         (lcoreid_t) cur_fwd_config.nb_fwd_ports;
3851         setup_fwd_config_of_each_lcore(&cur_fwd_config);
3852
3853         for (i = 0; i < cur_fwd_config.nb_fwd_ports; i++) {
3854                 fwd_streams[i]->rx_port   = fwd_ports_ids[i];
3855                 fwd_streams[i]->rx_queue  = 0;
3856                 fwd_streams[i]->tx_port   =
3857                                 fwd_ports_ids[fwd_topology_tx_port_get(i)];
3858                 fwd_streams[i]->tx_queue  = 0;
3859                 fwd_streams[i]->peer_addr = fwd_streams[i]->tx_port;
3860                 fwd_streams[i]->retry_enabled = retry_enabled;
3861         }
3862 }
3863
3864 /**
3865  * For the RSS forwarding test all streams distributed over lcores. Each stream
3866  * being composed of a RX queue to poll on a RX port for input messages,
3867  * associated with a TX queue of a TX port where to send forwarded packets.
3868  */
3869 static void
3870 rss_fwd_config_setup(void)
3871 {
3872         portid_t   rxp;
3873         portid_t   txp;
3874         queueid_t  rxq;
3875         queueid_t  nb_q;
3876         streamid_t  sm_id;
3877         int start;
3878         int end;
3879
3880         nb_q = nb_rxq;
3881         if (nb_q > nb_txq)
3882                 nb_q = nb_txq;
3883         cur_fwd_config.nb_fwd_lcores = (lcoreid_t) nb_fwd_lcores;
3884         cur_fwd_config.nb_fwd_ports = nb_fwd_ports;
3885         cur_fwd_config.nb_fwd_streams =
3886                 (streamid_t) (nb_q * cur_fwd_config.nb_fwd_ports);
3887
3888         if (cur_fwd_config.nb_fwd_streams < cur_fwd_config.nb_fwd_lcores)
3889                 cur_fwd_config.nb_fwd_lcores =
3890                         (lcoreid_t)cur_fwd_config.nb_fwd_streams;
3891
3892         /* reinitialize forwarding streams */
3893         init_fwd_streams();
3894
3895         setup_fwd_config_of_each_lcore(&cur_fwd_config);
3896
3897         if (proc_id > 0 && nb_q % num_procs != 0)
3898                 printf("Warning! queue numbers should be multiple of processes, or packet loss will happen.\n");
3899
3900         /**
3901          * In multi-process, All queues are allocated to different
3902          * processes based on num_procs and proc_id. For example:
3903          * if supports 4 queues(nb_q), 2 processes(num_procs),
3904          * the 0~1 queue for primary process.
3905          * the 2~3 queue for secondary process.
3906          */
3907         start = proc_id * nb_q / num_procs;
3908         end = start + nb_q / num_procs;
3909         rxp = 0;
3910         rxq = start;
3911         for (sm_id = 0; sm_id < cur_fwd_config.nb_fwd_streams; sm_id++) {
3912                 struct fwd_stream *fs;
3913
3914                 fs = fwd_streams[sm_id];
3915                 txp = fwd_topology_tx_port_get(rxp);
3916                 fs->rx_port = fwd_ports_ids[rxp];
3917                 fs->rx_queue = rxq;
3918                 fs->tx_port = fwd_ports_ids[txp];
3919                 fs->tx_queue = rxq;
3920                 fs->peer_addr = fs->tx_port;
3921                 fs->retry_enabled = retry_enabled;
3922                 rxp++;
3923                 if (rxp < nb_fwd_ports)
3924                         continue;
3925                 rxp = 0;
3926                 rxq++;
3927                 if (rxq >= end)
3928                         rxq = start;
3929         }
3930 }
3931
3932 static uint16_t
3933 get_fwd_port_total_tc_num(void)
3934 {
3935         struct rte_eth_dcb_info dcb_info;
3936         uint16_t total_tc_num = 0;
3937         unsigned int i;
3938
3939         for (i = 0; i < nb_fwd_ports; i++) {
3940                 (void)rte_eth_dev_get_dcb_info(fwd_ports_ids[i], &dcb_info);
3941                 total_tc_num += dcb_info.nb_tcs;
3942         }
3943
3944         return total_tc_num;
3945 }
3946
3947 /**
3948  * For the DCB forwarding test, each core is assigned on each traffic class.
3949  *
3950  * Each core is assigned a multi-stream, each stream being composed of
3951  * a RX queue to poll on a RX port for input messages, associated with
3952  * a TX queue of a TX port where to send forwarded packets. All RX and
3953  * TX queues are mapping to the same traffic class.
3954  * If VMDQ and DCB co-exist, each traffic class on different POOLs share
3955  * the same core
3956  */
3957 static void
3958 dcb_fwd_config_setup(void)
3959 {
3960         struct rte_eth_dcb_info rxp_dcb_info, txp_dcb_info;
3961         portid_t txp, rxp = 0;
3962         queueid_t txq, rxq = 0;
3963         lcoreid_t  lc_id;
3964         uint16_t nb_rx_queue, nb_tx_queue;
3965         uint16_t i, j, k, sm_id = 0;
3966         uint16_t total_tc_num;
3967         struct rte_port *port;
3968         uint8_t tc = 0;
3969         portid_t pid;
3970         int ret;
3971
3972         /*
3973          * The fwd_config_setup() is called when the port is RTE_PORT_STARTED
3974          * or RTE_PORT_STOPPED.
3975          *
3976          * Re-configure ports to get updated mapping between tc and queue in
3977          * case the queue number of the port is changed. Skip for started ports
3978          * since modifying queue number and calling dev_configure need to stop
3979          * ports first.
3980          */
3981         for (pid = 0; pid < nb_fwd_ports; pid++) {
3982                 if (port_is_started(pid) == 1)
3983                         continue;
3984
3985                 port = &ports[pid];
3986                 ret = rte_eth_dev_configure(pid, nb_rxq, nb_txq,
3987                                             &port->dev_conf);
3988                 if (ret < 0) {
3989                         fprintf(stderr,
3990                                 "Failed to re-configure port %d, ret = %d.\n",
3991                                 pid, ret);
3992                         return;
3993                 }
3994         }
3995
3996         cur_fwd_config.nb_fwd_lcores = (lcoreid_t) nb_fwd_lcores;
3997         cur_fwd_config.nb_fwd_ports = nb_fwd_ports;
3998         cur_fwd_config.nb_fwd_streams =
3999                 (streamid_t) (nb_rxq * cur_fwd_config.nb_fwd_ports);
4000         total_tc_num = get_fwd_port_total_tc_num();
4001         if (cur_fwd_config.nb_fwd_lcores > total_tc_num)
4002                 cur_fwd_config.nb_fwd_lcores = total_tc_num;
4003
4004         /* reinitialize forwarding streams */
4005         init_fwd_streams();
4006         sm_id = 0;
4007         txp = 1;
4008         /* get the dcb info on the first RX and TX ports */
4009         (void)rte_eth_dev_get_dcb_info(fwd_ports_ids[rxp], &rxp_dcb_info);
4010         (void)rte_eth_dev_get_dcb_info(fwd_ports_ids[txp], &txp_dcb_info);
4011
4012         for (lc_id = 0; lc_id < cur_fwd_config.nb_fwd_lcores; lc_id++) {
4013                 fwd_lcores[lc_id]->stream_nb = 0;
4014                 fwd_lcores[lc_id]->stream_idx = sm_id;
4015                 for (i = 0; i < RTE_ETH_MAX_VMDQ_POOL; i++) {
4016                         /* if the nb_queue is zero, means this tc is
4017                          * not enabled on the POOL
4018                          */
4019                         if (rxp_dcb_info.tc_queue.tc_rxq[i][tc].nb_queue == 0)
4020                                 break;
4021                         k = fwd_lcores[lc_id]->stream_nb +
4022                                 fwd_lcores[lc_id]->stream_idx;
4023                         rxq = rxp_dcb_info.tc_queue.tc_rxq[i][tc].base;
4024                         txq = txp_dcb_info.tc_queue.tc_txq[i][tc].base;
4025                         nb_rx_queue = txp_dcb_info.tc_queue.tc_rxq[i][tc].nb_queue;
4026                         nb_tx_queue = txp_dcb_info.tc_queue.tc_txq[i][tc].nb_queue;
4027                         for (j = 0; j < nb_rx_queue; j++) {
4028                                 struct fwd_stream *fs;
4029
4030                                 fs = fwd_streams[k + j];
4031                                 fs->rx_port = fwd_ports_ids[rxp];
4032                                 fs->rx_queue = rxq + j;
4033                                 fs->tx_port = fwd_ports_ids[txp];
4034                                 fs->tx_queue = txq + j % nb_tx_queue;
4035                                 fs->peer_addr = fs->tx_port;
4036                                 fs->retry_enabled = retry_enabled;
4037                         }
4038                         fwd_lcores[lc_id]->stream_nb +=
4039                                 rxp_dcb_info.tc_queue.tc_rxq[i][tc].nb_queue;
4040                 }
4041                 sm_id = (streamid_t) (sm_id + fwd_lcores[lc_id]->stream_nb);
4042
4043                 tc++;
4044                 if (tc < rxp_dcb_info.nb_tcs)
4045                         continue;
4046                 /* Restart from TC 0 on next RX port */
4047                 tc = 0;
4048                 if (numa_support && (nb_fwd_ports <= (nb_ports >> 1)))
4049                         rxp = (portid_t)
4050                                 (rxp + ((nb_ports >> 1) / nb_fwd_ports));
4051                 else
4052                         rxp++;
4053                 if (rxp >= nb_fwd_ports)
4054                         return;
4055                 /* get the dcb information on next RX and TX ports */
4056                 if ((rxp & 0x1) == 0)
4057                         txp = (portid_t) (rxp + 1);
4058                 else
4059                         txp = (portid_t) (rxp - 1);
4060                 rte_eth_dev_get_dcb_info(fwd_ports_ids[rxp], &rxp_dcb_info);
4061                 rte_eth_dev_get_dcb_info(fwd_ports_ids[txp], &txp_dcb_info);
4062         }
4063 }
4064
4065 static void
4066 icmp_echo_config_setup(void)
4067 {
4068         portid_t  rxp;
4069         queueid_t rxq;
4070         lcoreid_t lc_id;
4071         uint16_t  sm_id;
4072
4073         if ((nb_txq * nb_fwd_ports) < nb_fwd_lcores)
4074                 cur_fwd_config.nb_fwd_lcores = (lcoreid_t)
4075                         (nb_txq * nb_fwd_ports);
4076         else
4077                 cur_fwd_config.nb_fwd_lcores = (lcoreid_t) nb_fwd_lcores;
4078         cur_fwd_config.nb_fwd_ports = nb_fwd_ports;
4079         cur_fwd_config.nb_fwd_streams =
4080                 (streamid_t) (nb_rxq * cur_fwd_config.nb_fwd_ports);
4081         if (cur_fwd_config.nb_fwd_streams < cur_fwd_config.nb_fwd_lcores)
4082                 cur_fwd_config.nb_fwd_lcores =
4083                         (lcoreid_t)cur_fwd_config.nb_fwd_streams;
4084         if (verbose_level > 0) {
4085                 printf("%s fwd_cores=%d fwd_ports=%d fwd_streams=%d\n",
4086                        __FUNCTION__,
4087                        cur_fwd_config.nb_fwd_lcores,
4088                        cur_fwd_config.nb_fwd_ports,
4089                        cur_fwd_config.nb_fwd_streams);
4090         }
4091
4092         /* reinitialize forwarding streams */
4093         init_fwd_streams();
4094         setup_fwd_config_of_each_lcore(&cur_fwd_config);
4095         rxp = 0; rxq = 0;
4096         for (lc_id = 0; lc_id < cur_fwd_config.nb_fwd_lcores; lc_id++) {
4097                 if (verbose_level > 0)
4098                         printf("  core=%d: \n", lc_id);
4099                 for (sm_id = 0; sm_id < fwd_lcores[lc_id]->stream_nb; sm_id++) {
4100                         struct fwd_stream *fs;
4101                         fs = fwd_streams[fwd_lcores[lc_id]->stream_idx + sm_id];
4102                         fs->rx_port = fwd_ports_ids[rxp];
4103                         fs->rx_queue = rxq;
4104                         fs->tx_port = fs->rx_port;
4105                         fs->tx_queue = rxq;
4106                         fs->peer_addr = fs->tx_port;
4107                         fs->retry_enabled = retry_enabled;
4108                         if (verbose_level > 0)
4109                                 printf("  stream=%d port=%d rxq=%d txq=%d\n",
4110                                        sm_id, fs->rx_port, fs->rx_queue,
4111                                        fs->tx_queue);
4112                         rxq = (queueid_t) (rxq + 1);
4113                         if (rxq == nb_rxq) {
4114                                 rxq = 0;
4115                                 rxp = (portid_t) (rxp + 1);
4116                         }
4117                 }
4118         }
4119 }
4120
4121 void
4122 fwd_config_setup(void)
4123 {
4124         struct rte_port *port;
4125         portid_t pt_id;
4126         unsigned int i;
4127
4128         cur_fwd_config.fwd_eng = cur_fwd_eng;
4129         if (strcmp(cur_fwd_eng->fwd_mode_name, "icmpecho") == 0) {
4130                 icmp_echo_config_setup();
4131                 return;
4132         }
4133
4134         if ((nb_rxq > 1) && (nb_txq > 1)){
4135                 if (dcb_config) {
4136                         for (i = 0; i < nb_fwd_ports; i++) {
4137                                 pt_id = fwd_ports_ids[i];
4138                                 port = &ports[pt_id];
4139                                 if (!port->dcb_flag) {
4140                                         fprintf(stderr,
4141                                                 "In DCB mode, all forwarding ports must be configured in this mode.\n");
4142                                         return;
4143                                 }
4144                         }
4145                         if (nb_fwd_lcores == 1) {
4146                                 fprintf(stderr,
4147                                         "In DCB mode,the nb forwarding cores should be larger than 1.\n");
4148                                 return;
4149                         }
4150
4151                         dcb_fwd_config_setup();
4152                 } else
4153                         rss_fwd_config_setup();
4154         }
4155         else
4156                 simple_fwd_config_setup();
4157 }
4158
4159 static const char *
4160 mp_alloc_to_str(uint8_t mode)
4161 {
4162         switch (mode) {
4163         case MP_ALLOC_NATIVE:
4164                 return "native";
4165         case MP_ALLOC_ANON:
4166                 return "anon";
4167         case MP_ALLOC_XMEM:
4168                 return "xmem";
4169         case MP_ALLOC_XMEM_HUGE:
4170                 return "xmemhuge";
4171         case MP_ALLOC_XBUF:
4172                 return "xbuf";
4173         default:
4174                 return "invalid";
4175         }
4176 }
4177
4178 void
4179 pkt_fwd_config_display(struct fwd_config *cfg)
4180 {
4181         struct fwd_stream *fs;
4182         lcoreid_t  lc_id;
4183         streamid_t sm_id;
4184
4185         printf("%s packet forwarding%s - ports=%d - cores=%d - streams=%d - "
4186                 "NUMA support %s, MP allocation mode: %s\n",
4187                 cfg->fwd_eng->fwd_mode_name,
4188                 retry_enabled == 0 ? "" : " with retry",
4189                 cfg->nb_fwd_ports, cfg->nb_fwd_lcores, cfg->nb_fwd_streams,
4190                 numa_support == 1 ? "enabled" : "disabled",
4191                 mp_alloc_to_str(mp_alloc_type));
4192
4193         if (retry_enabled)
4194                 printf("TX retry num: %u, delay between TX retries: %uus\n",
4195                         burst_tx_retry_num, burst_tx_delay_time);
4196         for (lc_id = 0; lc_id < cfg->nb_fwd_lcores; lc_id++) {
4197                 printf("Logical Core %u (socket %u) forwards packets on "
4198                        "%d streams:",
4199                        fwd_lcores_cpuids[lc_id],
4200                        rte_lcore_to_socket_id(fwd_lcores_cpuids[lc_id]),
4201                        fwd_lcores[lc_id]->stream_nb);
4202                 for (sm_id = 0; sm_id < fwd_lcores[lc_id]->stream_nb; sm_id++) {
4203                         fs = fwd_streams[fwd_lcores[lc_id]->stream_idx + sm_id];
4204                         printf("\n  RX P=%d/Q=%d (socket %u) -> TX "
4205                                "P=%d/Q=%d (socket %u) ",
4206                                fs->rx_port, fs->rx_queue,
4207                                ports[fs->rx_port].socket_id,
4208                                fs->tx_port, fs->tx_queue,
4209                                ports[fs->tx_port].socket_id);
4210                         print_ethaddr("peer=",
4211                                       &peer_eth_addrs[fs->peer_addr]);
4212                 }
4213                 printf("\n");
4214         }
4215         printf("\n");
4216 }
4217
4218 void
4219 set_fwd_eth_peer(portid_t port_id, char *peer_addr)
4220 {
4221         struct rte_ether_addr new_peer_addr;
4222         if (!rte_eth_dev_is_valid_port(port_id)) {
4223                 fprintf(stderr, "Error: Invalid port number %i\n", port_id);
4224                 return;
4225         }
4226         if (rte_ether_unformat_addr(peer_addr, &new_peer_addr) < 0) {
4227                 fprintf(stderr, "Error: Invalid ethernet address: %s\n",
4228                         peer_addr);
4229                 return;
4230         }
4231         peer_eth_addrs[port_id] = new_peer_addr;
4232 }
4233
4234 int
4235 set_fwd_lcores_list(unsigned int *lcorelist, unsigned int nb_lc)
4236 {
4237         unsigned int i;
4238         unsigned int lcore_cpuid;
4239         int record_now;
4240
4241         record_now = 0;
4242  again:
4243         for (i = 0; i < nb_lc; i++) {
4244                 lcore_cpuid = lcorelist[i];
4245                 if (! rte_lcore_is_enabled(lcore_cpuid)) {
4246                         fprintf(stderr, "lcore %u not enabled\n", lcore_cpuid);
4247                         return -1;
4248                 }
4249                 if (lcore_cpuid == rte_get_main_lcore()) {
4250                         fprintf(stderr,
4251                                 "lcore %u cannot be masked on for running packet forwarding, which is the main lcore and reserved for command line parsing only\n",
4252                                 lcore_cpuid);
4253                         return -1;
4254                 }
4255                 if (record_now)
4256                         fwd_lcores_cpuids[i] = lcore_cpuid;
4257         }
4258         if (record_now == 0) {
4259                 record_now = 1;
4260                 goto again;
4261         }
4262         nb_cfg_lcores = (lcoreid_t) nb_lc;
4263         if (nb_fwd_lcores != (lcoreid_t) nb_lc) {
4264                 printf("previous number of forwarding cores %u - changed to "
4265                        "number of configured cores %u\n",
4266                        (unsigned int) nb_fwd_lcores, nb_lc);
4267                 nb_fwd_lcores = (lcoreid_t) nb_lc;
4268         }
4269
4270         return 0;
4271 }
4272
4273 int
4274 set_fwd_lcores_mask(uint64_t lcoremask)
4275 {
4276         unsigned int lcorelist[64];
4277         unsigned int nb_lc;
4278         unsigned int i;
4279
4280         if (lcoremask == 0) {
4281                 fprintf(stderr, "Invalid NULL mask of cores\n");
4282                 return -1;
4283         }
4284         nb_lc = 0;
4285         for (i = 0; i < 64; i++) {
4286                 if (! ((uint64_t)(1ULL << i) & lcoremask))
4287                         continue;
4288                 lcorelist[nb_lc++] = i;
4289         }
4290         return set_fwd_lcores_list(lcorelist, nb_lc);
4291 }
4292
4293 void
4294 set_fwd_lcores_number(uint16_t nb_lc)
4295 {
4296         if (test_done == 0) {
4297                 fprintf(stderr, "Please stop forwarding first\n");
4298                 return;
4299         }
4300         if (nb_lc > nb_cfg_lcores) {
4301                 fprintf(stderr,
4302                         "nb fwd cores %u > %u (max. number of configured lcores) - ignored\n",
4303                         (unsigned int) nb_lc, (unsigned int) nb_cfg_lcores);
4304                 return;
4305         }
4306         nb_fwd_lcores = (lcoreid_t) nb_lc;
4307         printf("Number of forwarding cores set to %u\n",
4308                (unsigned int) nb_fwd_lcores);
4309 }
4310
4311 void
4312 set_fwd_ports_list(unsigned int *portlist, unsigned int nb_pt)
4313 {
4314         unsigned int i;
4315         portid_t port_id;
4316         int record_now;
4317
4318         record_now = 0;
4319  again:
4320         for (i = 0; i < nb_pt; i++) {
4321                 port_id = (portid_t) portlist[i];
4322                 if (port_id_is_invalid(port_id, ENABLED_WARN))
4323                         return;
4324                 if (record_now)
4325                         fwd_ports_ids[i] = port_id;
4326         }
4327         if (record_now == 0) {
4328                 record_now = 1;
4329                 goto again;
4330         }
4331         nb_cfg_ports = (portid_t) nb_pt;
4332         if (nb_fwd_ports != (portid_t) nb_pt) {
4333                 printf("previous number of forwarding ports %u - changed to "
4334                        "number of configured ports %u\n",
4335                        (unsigned int) nb_fwd_ports, nb_pt);
4336                 nb_fwd_ports = (portid_t) nb_pt;
4337         }
4338 }
4339
4340 /**
4341  * Parse the user input and obtain the list of forwarding ports
4342  *
4343  * @param[in] list
4344  *   String containing the user input. User can specify
4345  *   in these formats 1,3,5 or 1-3 or 1-2,5 or 3,5-6.
4346  *   For example, if the user wants to use all the available
4347  *   4 ports in his system, then the input can be 0-3 or 0,1,2,3.
4348  *   If the user wants to use only the ports 1,2 then the input
4349  *   is 1,2.
4350  *   valid characters are '-' and ','
4351  * @param[out] values
4352  *   This array will be filled with a list of port IDs
4353  *   based on the user input
4354  *   Note that duplicate entries are discarded and only the first
4355  *   count entries in this array are port IDs and all the rest
4356  *   will contain default values
4357  * @param[in] maxsize
4358  *   This parameter denotes 2 things
4359  *   1) Number of elements in the values array
4360  *   2) Maximum value of each element in the values array
4361  * @return
4362  *   On success, returns total count of parsed port IDs
4363  *   On failure, returns 0
4364  */
4365 static unsigned int
4366 parse_port_list(const char *list, unsigned int *values, unsigned int maxsize)
4367 {
4368         unsigned int count = 0;
4369         char *end = NULL;
4370         int min, max;
4371         int value, i;
4372         unsigned int marked[maxsize];
4373
4374         if (list == NULL || values == NULL)
4375                 return 0;
4376
4377         for (i = 0; i < (int)maxsize; i++)
4378                 marked[i] = 0;
4379
4380         min = INT_MAX;
4381
4382         do {
4383                 /*Remove the blank spaces if any*/
4384                 while (isblank(*list))
4385                         list++;
4386                 if (*list == '\0')
4387                         break;
4388                 errno = 0;
4389                 value = strtol(list, &end, 10);
4390                 if (errno || end == NULL)
4391                         return 0;
4392                 if (value < 0 || value >= (int)maxsize)
4393                         return 0;
4394                 while (isblank(*end))
4395                         end++;
4396                 if (*end == '-' && min == INT_MAX) {
4397                         min = value;
4398                 } else if ((*end == ',') || (*end == '\0')) {
4399                         max = value;
4400                         if (min == INT_MAX)
4401                                 min = value;
4402                         for (i = min; i <= max; i++) {
4403                                 if (count < maxsize) {
4404                                         if (marked[i])
4405                                                 continue;
4406                                         values[count] = i;
4407                                         marked[i] = 1;
4408                                         count++;
4409                                 }
4410                         }
4411                         min = INT_MAX;
4412                 } else
4413                         return 0;
4414                 list = end + 1;
4415         } while (*end != '\0');
4416
4417         return count;
4418 }
4419
4420 void
4421 parse_fwd_portlist(const char *portlist)
4422 {
4423         unsigned int portcount;
4424         unsigned int portindex[RTE_MAX_ETHPORTS];
4425         unsigned int i, valid_port_count = 0;
4426
4427         portcount = parse_port_list(portlist, portindex, RTE_MAX_ETHPORTS);
4428         if (!portcount)
4429                 rte_exit(EXIT_FAILURE, "Invalid fwd port list\n");
4430
4431         /*
4432          * Here we verify the validity of the ports
4433          * and thereby calculate the total number of
4434          * valid ports
4435          */
4436         for (i = 0; i < portcount && i < RTE_DIM(portindex); i++) {
4437                 if (rte_eth_dev_is_valid_port(portindex[i])) {
4438                         portindex[valid_port_count] = portindex[i];
4439                         valid_port_count++;
4440                 }
4441         }
4442
4443         set_fwd_ports_list(portindex, valid_port_count);
4444 }
4445
4446 void
4447 set_fwd_ports_mask(uint64_t portmask)
4448 {
4449         unsigned int portlist[64];
4450         unsigned int nb_pt;
4451         unsigned int i;
4452
4453         if (portmask == 0) {
4454                 fprintf(stderr, "Invalid NULL mask of ports\n");
4455                 return;
4456         }
4457         nb_pt = 0;
4458         RTE_ETH_FOREACH_DEV(i) {
4459                 if (! ((uint64_t)(1ULL << i) & portmask))
4460                         continue;
4461                 portlist[nb_pt++] = i;
4462         }
4463         set_fwd_ports_list(portlist, nb_pt);
4464 }
4465
4466 void
4467 set_fwd_ports_number(uint16_t nb_pt)
4468 {
4469         if (nb_pt > nb_cfg_ports) {
4470                 fprintf(stderr,
4471                         "nb fwd ports %u > %u (number of configured ports) - ignored\n",
4472                         (unsigned int) nb_pt, (unsigned int) nb_cfg_ports);
4473                 return;
4474         }
4475         nb_fwd_ports = (portid_t) nb_pt;
4476         printf("Number of forwarding ports set to %u\n",
4477                (unsigned int) nb_fwd_ports);
4478 }
4479
4480 int
4481 port_is_forwarding(portid_t port_id)
4482 {
4483         unsigned int i;
4484
4485         if (port_id_is_invalid(port_id, ENABLED_WARN))
4486                 return -1;
4487
4488         for (i = 0; i < nb_fwd_ports; i++) {
4489                 if (fwd_ports_ids[i] == port_id)
4490                         return 1;
4491         }
4492
4493         return 0;
4494 }
4495
4496 void
4497 set_nb_pkt_per_burst(uint16_t nb)
4498 {
4499         if (nb > MAX_PKT_BURST) {
4500                 fprintf(stderr,
4501                         "nb pkt per burst: %u > %u (maximum packet per burst)  ignored\n",
4502                         (unsigned int) nb, (unsigned int) MAX_PKT_BURST);
4503                 return;
4504         }
4505         nb_pkt_per_burst = nb;
4506         printf("Number of packets per burst set to %u\n",
4507                (unsigned int) nb_pkt_per_burst);
4508 }
4509
4510 static const char *
4511 tx_split_get_name(enum tx_pkt_split split)
4512 {
4513         uint32_t i;
4514
4515         for (i = 0; i != RTE_DIM(tx_split_name); i++) {
4516                 if (tx_split_name[i].split == split)
4517                         return tx_split_name[i].name;
4518         }
4519         return NULL;
4520 }
4521
4522 void
4523 set_tx_pkt_split(const char *name)
4524 {
4525         uint32_t i;
4526
4527         for (i = 0; i != RTE_DIM(tx_split_name); i++) {
4528                 if (strcmp(tx_split_name[i].name, name) == 0) {
4529                         tx_pkt_split = tx_split_name[i].split;
4530                         return;
4531                 }
4532         }
4533         fprintf(stderr, "unknown value: \"%s\"\n", name);
4534 }
4535
4536 int
4537 parse_fec_mode(const char *name, uint32_t *fec_capa)
4538 {
4539         uint8_t i;
4540
4541         for (i = 0; i < RTE_DIM(fec_mode_name); i++) {
4542                 if (strcmp(fec_mode_name[i].name, name) == 0) {
4543                         *fec_capa =
4544                                 RTE_ETH_FEC_MODE_TO_CAPA(fec_mode_name[i].mode);
4545                         return 0;
4546                 }
4547         }
4548         return -1;
4549 }
4550
4551 void
4552 show_fec_capability(unsigned int num, struct rte_eth_fec_capa *speed_fec_capa)
4553 {
4554         unsigned int i, j;
4555
4556         printf("FEC capabilities:\n");
4557
4558         for (i = 0; i < num; i++) {
4559                 printf("%s : ",
4560                         rte_eth_link_speed_to_str(speed_fec_capa[i].speed));
4561
4562                 for (j = 0; j < RTE_DIM(fec_mode_name); j++) {
4563                         if (RTE_ETH_FEC_MODE_TO_CAPA(j) &
4564                                                 speed_fec_capa[i].capa)
4565                                 printf("%s ", fec_mode_name[j].name);
4566                 }
4567                 printf("\n");
4568         }
4569 }
4570
4571 void
4572 show_rx_pkt_offsets(void)
4573 {
4574         uint32_t i, n;
4575
4576         n = rx_pkt_nb_offs;
4577         printf("Number of offsets: %u\n", n);
4578         if (n) {
4579                 printf("Segment offsets: ");
4580                 for (i = 0; i != n - 1; i++)
4581                         printf("%hu,", rx_pkt_seg_offsets[i]);
4582                 printf("%hu\n", rx_pkt_seg_lengths[i]);
4583         }
4584 }
4585
4586 void
4587 set_rx_pkt_offsets(unsigned int *seg_offsets, unsigned int nb_offs)
4588 {
4589         unsigned int i;
4590
4591         if (nb_offs >= MAX_SEGS_BUFFER_SPLIT) {
4592                 printf("nb segments per RX packets=%u >= "
4593                        "MAX_SEGS_BUFFER_SPLIT - ignored\n", nb_offs);
4594                 return;
4595         }
4596
4597         /*
4598          * No extra check here, the segment length will be checked by PMD
4599          * in the extended queue setup.
4600          */
4601         for (i = 0; i < nb_offs; i++) {
4602                 if (seg_offsets[i] >= UINT16_MAX) {
4603                         printf("offset[%u]=%u > UINT16_MAX - give up\n",
4604                                i, seg_offsets[i]);
4605                         return;
4606                 }
4607         }
4608
4609         for (i = 0; i < nb_offs; i++)
4610                 rx_pkt_seg_offsets[i] = (uint16_t) seg_offsets[i];
4611
4612         rx_pkt_nb_offs = (uint8_t) nb_offs;
4613 }
4614
4615 void
4616 show_rx_pkt_segments(void)
4617 {
4618         uint32_t i, n;
4619
4620         n = rx_pkt_nb_segs;
4621         printf("Number of segments: %u\n", n);
4622         if (n) {
4623                 printf("Segment sizes: ");
4624                 for (i = 0; i != n - 1; i++)
4625                         printf("%hu,", rx_pkt_seg_lengths[i]);
4626                 printf("%hu\n", rx_pkt_seg_lengths[i]);
4627         }
4628 }
4629
4630 void
4631 set_rx_pkt_segments(unsigned int *seg_lengths, unsigned int nb_segs)
4632 {
4633         unsigned int i;
4634
4635         if (nb_segs >= MAX_SEGS_BUFFER_SPLIT) {
4636                 printf("nb segments per RX packets=%u >= "
4637                        "MAX_SEGS_BUFFER_SPLIT - ignored\n", nb_segs);
4638                 return;
4639         }
4640
4641         /*
4642          * No extra check here, the segment length will be checked by PMD
4643          * in the extended queue setup.
4644          */
4645         for (i = 0; i < nb_segs; i++) {
4646                 if (seg_lengths[i] >= UINT16_MAX) {
4647                         printf("length[%u]=%u > UINT16_MAX - give up\n",
4648                                i, seg_lengths[i]);
4649                         return;
4650                 }
4651         }
4652
4653         for (i = 0; i < nb_segs; i++)
4654                 rx_pkt_seg_lengths[i] = (uint16_t) seg_lengths[i];
4655
4656         rx_pkt_nb_segs = (uint8_t) nb_segs;
4657 }
4658
4659 void
4660 show_tx_pkt_segments(void)
4661 {
4662         uint32_t i, n;
4663         const char *split;
4664
4665         n = tx_pkt_nb_segs;
4666         split = tx_split_get_name(tx_pkt_split);
4667
4668         printf("Number of segments: %u\n", n);
4669         printf("Segment sizes: ");
4670         for (i = 0; i != n - 1; i++)
4671                 printf("%hu,", tx_pkt_seg_lengths[i]);
4672         printf("%hu\n", tx_pkt_seg_lengths[i]);
4673         printf("Split packet: %s\n", split);
4674 }
4675
4676 static bool
4677 nb_segs_is_invalid(unsigned int nb_segs)
4678 {
4679         uint16_t ring_size;
4680         uint16_t queue_id;
4681         uint16_t port_id;
4682         int ret;
4683
4684         RTE_ETH_FOREACH_DEV(port_id) {
4685                 for (queue_id = 0; queue_id < nb_txq; queue_id++) {
4686                         ret = get_tx_ring_size(port_id, queue_id, &ring_size);
4687                         if (ret) {
4688                                 /* Port may not be initialized yet, can't say
4689                                  * the port is invalid in this stage.
4690                                  */
4691                                 continue;
4692                         }
4693                         if (ring_size < nb_segs) {
4694                                 printf("nb segments per TX packets=%u >= TX "
4695                                        "queue(%u) ring_size=%u - txpkts ignored\n",
4696                                        nb_segs, queue_id, ring_size);
4697                                 return true;
4698                         }
4699                 }
4700         }
4701
4702         return false;
4703 }
4704
4705 void
4706 set_tx_pkt_segments(unsigned int *seg_lengths, unsigned int nb_segs)
4707 {
4708         uint16_t tx_pkt_len;
4709         unsigned int i;
4710
4711         /*
4712          * For single segment settings failed check is ignored.
4713          * It is a very basic capability to send the single segment
4714          * packets, suppose it is always supported.
4715          */
4716         if (nb_segs > 1 && nb_segs_is_invalid(nb_segs)) {
4717                 fprintf(stderr,
4718                         "Tx segment size(%u) is not supported - txpkts ignored\n",
4719                         nb_segs);
4720                 return;
4721         }
4722
4723         if (nb_segs > RTE_MAX_SEGS_PER_PKT) {
4724                 fprintf(stderr,
4725                         "Tx segment size(%u) is bigger than max number of segment(%u)\n",
4726                         nb_segs, RTE_MAX_SEGS_PER_PKT);
4727                 return;
4728         }
4729
4730         /*
4731          * Check that each segment length is greater or equal than
4732          * the mbuf data size.
4733          * Check also that the total packet length is greater or equal than the
4734          * size of an empty UDP/IP packet (sizeof(struct rte_ether_hdr) +
4735          * 20 + 8).
4736          */
4737         tx_pkt_len = 0;
4738         for (i = 0; i < nb_segs; i++) {
4739                 if (seg_lengths[i] > mbuf_data_size[0]) {
4740                         fprintf(stderr,
4741                                 "length[%u]=%u > mbuf_data_size=%u - give up\n",
4742                                 i, seg_lengths[i], mbuf_data_size[0]);
4743                         return;
4744                 }
4745                 tx_pkt_len = (uint16_t)(tx_pkt_len + seg_lengths[i]);
4746         }
4747         if (tx_pkt_len < (sizeof(struct rte_ether_hdr) + 20 + 8)) {
4748                 fprintf(stderr, "total packet length=%u < %d - give up\n",
4749                                 (unsigned) tx_pkt_len,
4750                                 (int)(sizeof(struct rte_ether_hdr) + 20 + 8));
4751                 return;
4752         }
4753
4754         for (i = 0; i < nb_segs; i++)
4755                 tx_pkt_seg_lengths[i] = (uint16_t) seg_lengths[i];
4756
4757         tx_pkt_length  = tx_pkt_len;
4758         tx_pkt_nb_segs = (uint8_t) nb_segs;
4759 }
4760
4761 void
4762 show_tx_pkt_times(void)
4763 {
4764         printf("Interburst gap: %u\n", tx_pkt_times_inter);
4765         printf("Intraburst gap: %u\n", tx_pkt_times_intra);
4766 }
4767
4768 void
4769 set_tx_pkt_times(unsigned int *tx_times)
4770 {
4771         tx_pkt_times_inter = tx_times[0];
4772         tx_pkt_times_intra = tx_times[1];
4773 }
4774
4775 #ifdef RTE_LIB_GRO
4776 void
4777 setup_gro(const char *onoff, portid_t port_id)
4778 {
4779         if (!rte_eth_dev_is_valid_port(port_id)) {
4780                 fprintf(stderr, "invalid port id %u\n", port_id);
4781                 return;
4782         }
4783         if (test_done == 0) {
4784                 fprintf(stderr,
4785                         "Before enable/disable GRO, please stop forwarding first\n");
4786                 return;
4787         }
4788         if (strcmp(onoff, "on") == 0) {
4789                 if (gro_ports[port_id].enable != 0) {
4790                         fprintf(stderr,
4791                                 "Port %u has enabled GRO. Please disable GRO first\n",
4792                                 port_id);
4793                         return;
4794                 }
4795                 if (gro_flush_cycles == GRO_DEFAULT_FLUSH_CYCLES) {
4796                         gro_ports[port_id].param.gro_types = RTE_GRO_TCP_IPV4;
4797                         gro_ports[port_id].param.max_flow_num =
4798                                 GRO_DEFAULT_FLOW_NUM;
4799                         gro_ports[port_id].param.max_item_per_flow =
4800                                 GRO_DEFAULT_ITEM_NUM_PER_FLOW;
4801                 }
4802                 gro_ports[port_id].enable = 1;
4803         } else {
4804                 if (gro_ports[port_id].enable == 0) {
4805                         fprintf(stderr, "Port %u has disabled GRO\n", port_id);
4806                         return;
4807                 }
4808                 gro_ports[port_id].enable = 0;
4809         }
4810 }
4811
4812 void
4813 setup_gro_flush_cycles(uint8_t cycles)
4814 {
4815         if (test_done == 0) {
4816                 fprintf(stderr,
4817                         "Before change flush interval for GRO, please stop forwarding first.\n");
4818                 return;
4819         }
4820
4821         if (cycles > GRO_MAX_FLUSH_CYCLES || cycles <
4822                         GRO_DEFAULT_FLUSH_CYCLES) {
4823                 fprintf(stderr,
4824                         "The flushing cycle be in the range of 1 to %u. Revert to the default value %u.\n",
4825                         GRO_MAX_FLUSH_CYCLES, GRO_DEFAULT_FLUSH_CYCLES);
4826                 cycles = GRO_DEFAULT_FLUSH_CYCLES;
4827         }
4828
4829         gro_flush_cycles = cycles;
4830 }
4831
4832 void
4833 show_gro(portid_t port_id)
4834 {
4835         struct rte_gro_param *param;
4836         uint32_t max_pkts_num;
4837
4838         param = &gro_ports[port_id].param;
4839
4840         if (!rte_eth_dev_is_valid_port(port_id)) {
4841                 fprintf(stderr, "Invalid port id %u.\n", port_id);
4842                 return;
4843         }
4844         if (gro_ports[port_id].enable) {
4845                 printf("GRO type: TCP/IPv4\n");
4846                 if (gro_flush_cycles == GRO_DEFAULT_FLUSH_CYCLES) {
4847                         max_pkts_num = param->max_flow_num *
4848                                 param->max_item_per_flow;
4849                 } else
4850                         max_pkts_num = MAX_PKT_BURST * GRO_MAX_FLUSH_CYCLES;
4851                 printf("Max number of packets to perform GRO: %u\n",
4852                                 max_pkts_num);
4853                 printf("Flushing cycles: %u\n", gro_flush_cycles);
4854         } else
4855                 printf("Port %u doesn't enable GRO.\n", port_id);
4856 }
4857 #endif /* RTE_LIB_GRO */
4858
4859 #ifdef RTE_LIB_GSO
4860 void
4861 setup_gso(const char *mode, portid_t port_id)
4862 {
4863         if (!rte_eth_dev_is_valid_port(port_id)) {
4864                 fprintf(stderr, "invalid port id %u\n", port_id);
4865                 return;
4866         }
4867         if (strcmp(mode, "on") == 0) {
4868                 if (test_done == 0) {
4869                         fprintf(stderr,
4870                                 "before enabling GSO, please stop forwarding first\n");
4871                         return;
4872                 }
4873                 gso_ports[port_id].enable = 1;
4874         } else if (strcmp(mode, "off") == 0) {
4875                 if (test_done == 0) {
4876                         fprintf(stderr,
4877                                 "before disabling GSO, please stop forwarding first\n");
4878                         return;
4879                 }
4880                 gso_ports[port_id].enable = 0;
4881         }
4882 }
4883 #endif /* RTE_LIB_GSO */
4884
4885 char*
4886 list_pkt_forwarding_modes(void)
4887 {
4888         static char fwd_modes[128] = "";
4889         const char *separator = "|";
4890         struct fwd_engine *fwd_eng;
4891         unsigned i = 0;
4892
4893         if (strlen (fwd_modes) == 0) {
4894                 while ((fwd_eng = fwd_engines[i++]) != NULL) {
4895                         strncat(fwd_modes, fwd_eng->fwd_mode_name,
4896                                         sizeof(fwd_modes) - strlen(fwd_modes) - 1);
4897                         strncat(fwd_modes, separator,
4898                                         sizeof(fwd_modes) - strlen(fwd_modes) - 1);
4899                 }
4900                 fwd_modes[strlen(fwd_modes) - strlen(separator)] = '\0';
4901         }
4902
4903         return fwd_modes;
4904 }
4905
4906 char*
4907 list_pkt_forwarding_retry_modes(void)
4908 {
4909         static char fwd_modes[128] = "";
4910         const char *separator = "|";
4911         struct fwd_engine *fwd_eng;
4912         unsigned i = 0;
4913
4914         if (strlen(fwd_modes) == 0) {
4915                 while ((fwd_eng = fwd_engines[i++]) != NULL) {
4916                         if (fwd_eng == &rx_only_engine)
4917                                 continue;
4918                         strncat(fwd_modes, fwd_eng->fwd_mode_name,
4919                                         sizeof(fwd_modes) -
4920                                         strlen(fwd_modes) - 1);
4921                         strncat(fwd_modes, separator,
4922                                         sizeof(fwd_modes) -
4923                                         strlen(fwd_modes) - 1);
4924                 }
4925                 fwd_modes[strlen(fwd_modes) - strlen(separator)] = '\0';
4926         }
4927
4928         return fwd_modes;
4929 }
4930
4931 void
4932 set_pkt_forwarding_mode(const char *fwd_mode_name)
4933 {
4934         struct fwd_engine *fwd_eng;
4935         unsigned i;
4936
4937         i = 0;
4938         while ((fwd_eng = fwd_engines[i]) != NULL) {
4939                 if (! strcmp(fwd_eng->fwd_mode_name, fwd_mode_name)) {
4940                         printf("Set %s packet forwarding mode%s\n",
4941                                fwd_mode_name,
4942                                retry_enabled == 0 ? "" : " with retry");
4943                         cur_fwd_eng = fwd_eng;
4944                         return;
4945                 }
4946                 i++;
4947         }
4948         fprintf(stderr, "Invalid %s packet forwarding mode\n", fwd_mode_name);
4949 }
4950
4951 void
4952 add_rx_dump_callbacks(portid_t portid)
4953 {
4954         struct rte_eth_dev_info dev_info;
4955         uint16_t queue;
4956         int ret;
4957
4958         if (port_id_is_invalid(portid, ENABLED_WARN))
4959                 return;
4960
4961         ret = eth_dev_info_get_print_err(portid, &dev_info);
4962         if (ret != 0)
4963                 return;
4964
4965         for (queue = 0; queue < dev_info.nb_rx_queues; queue++)
4966                 if (!ports[portid].rx_dump_cb[queue])
4967                         ports[portid].rx_dump_cb[queue] =
4968                                 rte_eth_add_rx_callback(portid, queue,
4969                                         dump_rx_pkts, NULL);
4970 }
4971
4972 void
4973 add_tx_dump_callbacks(portid_t portid)
4974 {
4975         struct rte_eth_dev_info dev_info;
4976         uint16_t queue;
4977         int ret;
4978
4979         if (port_id_is_invalid(portid, ENABLED_WARN))
4980                 return;
4981
4982         ret = eth_dev_info_get_print_err(portid, &dev_info);
4983         if (ret != 0)
4984                 return;
4985
4986         for (queue = 0; queue < dev_info.nb_tx_queues; queue++)
4987                 if (!ports[portid].tx_dump_cb[queue])
4988                         ports[portid].tx_dump_cb[queue] =
4989                                 rte_eth_add_tx_callback(portid, queue,
4990                                                         dump_tx_pkts, NULL);
4991 }
4992
4993 void
4994 remove_rx_dump_callbacks(portid_t portid)
4995 {
4996         struct rte_eth_dev_info dev_info;
4997         uint16_t queue;
4998         int ret;
4999
5000         if (port_id_is_invalid(portid, ENABLED_WARN))
5001                 return;
5002
5003         ret = eth_dev_info_get_print_err(portid, &dev_info);
5004         if (ret != 0)
5005                 return;
5006
5007         for (queue = 0; queue < dev_info.nb_rx_queues; queue++)
5008                 if (ports[portid].rx_dump_cb[queue]) {
5009                         rte_eth_remove_rx_callback(portid, queue,
5010                                 ports[portid].rx_dump_cb[queue]);
5011                         ports[portid].rx_dump_cb[queue] = NULL;
5012                 }
5013 }
5014
5015 void
5016 remove_tx_dump_callbacks(portid_t portid)
5017 {
5018         struct rte_eth_dev_info dev_info;
5019         uint16_t queue;
5020         int ret;
5021
5022         if (port_id_is_invalid(portid, ENABLED_WARN))
5023                 return;
5024
5025         ret = eth_dev_info_get_print_err(portid, &dev_info);
5026         if (ret != 0)
5027                 return;
5028
5029         for (queue = 0; queue < dev_info.nb_tx_queues; queue++)
5030                 if (ports[portid].tx_dump_cb[queue]) {
5031                         rte_eth_remove_tx_callback(portid, queue,
5032                                 ports[portid].tx_dump_cb[queue]);
5033                         ports[portid].tx_dump_cb[queue] = NULL;
5034                 }
5035 }
5036
5037 void
5038 configure_rxtx_dump_callbacks(uint16_t verbose)
5039 {
5040         portid_t portid;
5041
5042 #ifndef RTE_ETHDEV_RXTX_CALLBACKS
5043                 TESTPMD_LOG(ERR, "setting rxtx callbacks is not enabled\n");
5044                 return;
5045 #endif
5046
5047         RTE_ETH_FOREACH_DEV(portid)
5048         {
5049                 if (verbose == 1 || verbose > 2)
5050                         add_rx_dump_callbacks(portid);
5051                 else
5052                         remove_rx_dump_callbacks(portid);
5053                 if (verbose >= 2)
5054                         add_tx_dump_callbacks(portid);
5055                 else
5056                         remove_tx_dump_callbacks(portid);
5057         }
5058 }
5059
5060 void
5061 set_verbose_level(uint16_t vb_level)
5062 {
5063         printf("Change verbose level from %u to %u\n",
5064                (unsigned int) verbose_level, (unsigned int) vb_level);
5065         verbose_level = vb_level;
5066         configure_rxtx_dump_callbacks(verbose_level);
5067 }
5068
5069 void
5070 vlan_extend_set(portid_t port_id, int on)
5071 {
5072         int diag;
5073         int vlan_offload;
5074         uint64_t port_rx_offloads = ports[port_id].dev_conf.rxmode.offloads;
5075
5076         if (port_id_is_invalid(port_id, ENABLED_WARN))
5077                 return;
5078
5079         vlan_offload = rte_eth_dev_get_vlan_offload(port_id);
5080
5081         if (on) {
5082                 vlan_offload |= RTE_ETH_VLAN_EXTEND_OFFLOAD;
5083                 port_rx_offloads |= RTE_ETH_RX_OFFLOAD_VLAN_EXTEND;
5084         } else {
5085                 vlan_offload &= ~RTE_ETH_VLAN_EXTEND_OFFLOAD;
5086                 port_rx_offloads &= ~RTE_ETH_RX_OFFLOAD_VLAN_EXTEND;
5087         }
5088
5089         diag = rte_eth_dev_set_vlan_offload(port_id, vlan_offload);
5090         if (diag < 0) {
5091                 fprintf(stderr,
5092                         "rx_vlan_extend_set(port_pi=%d, on=%d) failed diag=%d\n",
5093                         port_id, on, diag);
5094                 return;
5095         }
5096         ports[port_id].dev_conf.rxmode.offloads = port_rx_offloads;
5097 }
5098
5099 void
5100 rx_vlan_strip_set(portid_t port_id, int on)
5101 {
5102         int diag;
5103         int vlan_offload;
5104         uint64_t port_rx_offloads = ports[port_id].dev_conf.rxmode.offloads;
5105
5106         if (port_id_is_invalid(port_id, ENABLED_WARN))
5107                 return;
5108
5109         vlan_offload = rte_eth_dev_get_vlan_offload(port_id);
5110
5111         if (on) {
5112                 vlan_offload |= RTE_ETH_VLAN_STRIP_OFFLOAD;
5113                 port_rx_offloads |= RTE_ETH_RX_OFFLOAD_VLAN_STRIP;
5114         } else {
5115                 vlan_offload &= ~RTE_ETH_VLAN_STRIP_OFFLOAD;
5116                 port_rx_offloads &= ~RTE_ETH_RX_OFFLOAD_VLAN_STRIP;
5117         }
5118
5119         diag = rte_eth_dev_set_vlan_offload(port_id, vlan_offload);
5120         if (diag < 0) {
5121                 fprintf(stderr,
5122                         "%s(port_pi=%d, on=%d) failed diag=%d\n",
5123                         __func__, port_id, on, diag);
5124                 return;
5125         }
5126         ports[port_id].dev_conf.rxmode.offloads = port_rx_offloads;
5127 }
5128
5129 void
5130 rx_vlan_strip_set_on_queue(portid_t port_id, uint16_t queue_id, int on)
5131 {
5132         int diag;
5133
5134         if (port_id_is_invalid(port_id, ENABLED_WARN))
5135                 return;
5136
5137         diag = rte_eth_dev_set_vlan_strip_on_queue(port_id, queue_id, on);
5138         if (diag < 0)
5139                 fprintf(stderr,
5140                         "%s(port_pi=%d, queue_id=%d, on=%d) failed diag=%d\n",
5141                         __func__, port_id, queue_id, on, diag);
5142 }
5143
5144 void
5145 rx_vlan_filter_set(portid_t port_id, int on)
5146 {
5147         int diag;
5148         int vlan_offload;
5149         uint64_t port_rx_offloads = ports[port_id].dev_conf.rxmode.offloads;
5150
5151         if (port_id_is_invalid(port_id, ENABLED_WARN))
5152                 return;
5153
5154         vlan_offload = rte_eth_dev_get_vlan_offload(port_id);
5155
5156         if (on) {
5157                 vlan_offload |= RTE_ETH_VLAN_FILTER_OFFLOAD;
5158                 port_rx_offloads |= RTE_ETH_RX_OFFLOAD_VLAN_FILTER;
5159         } else {
5160                 vlan_offload &= ~RTE_ETH_VLAN_FILTER_OFFLOAD;
5161                 port_rx_offloads &= ~RTE_ETH_RX_OFFLOAD_VLAN_FILTER;
5162         }
5163
5164         diag = rte_eth_dev_set_vlan_offload(port_id, vlan_offload);
5165         if (diag < 0) {
5166                 fprintf(stderr,
5167                         "%s(port_pi=%d, on=%d) failed diag=%d\n",
5168                         __func__, port_id, on, diag);
5169                 return;
5170         }
5171         ports[port_id].dev_conf.rxmode.offloads = port_rx_offloads;
5172 }
5173
5174 void
5175 rx_vlan_qinq_strip_set(portid_t port_id, int on)
5176 {
5177         int diag;
5178         int vlan_offload;
5179         uint64_t port_rx_offloads = ports[port_id].dev_conf.rxmode.offloads;
5180
5181         if (port_id_is_invalid(port_id, ENABLED_WARN))
5182                 return;
5183
5184         vlan_offload = rte_eth_dev_get_vlan_offload(port_id);
5185
5186         if (on) {
5187                 vlan_offload |= RTE_ETH_QINQ_STRIP_OFFLOAD;
5188                 port_rx_offloads |= RTE_ETH_RX_OFFLOAD_QINQ_STRIP;
5189         } else {
5190                 vlan_offload &= ~RTE_ETH_QINQ_STRIP_OFFLOAD;
5191                 port_rx_offloads &= ~RTE_ETH_RX_OFFLOAD_QINQ_STRIP;
5192         }
5193
5194         diag = rte_eth_dev_set_vlan_offload(port_id, vlan_offload);
5195         if (diag < 0) {
5196                 fprintf(stderr, "%s(port_pi=%d, on=%d) failed diag=%d\n",
5197                         __func__, port_id, on, diag);
5198                 return;
5199         }
5200         ports[port_id].dev_conf.rxmode.offloads = port_rx_offloads;
5201 }
5202
5203 int
5204 rx_vft_set(portid_t port_id, uint16_t vlan_id, int on)
5205 {
5206         int diag;
5207
5208         if (port_id_is_invalid(port_id, ENABLED_WARN))
5209                 return 1;
5210         if (vlan_id_is_invalid(vlan_id))
5211                 return 1;
5212         diag = rte_eth_dev_vlan_filter(port_id, vlan_id, on);
5213         if (diag == 0)
5214                 return 0;
5215         fprintf(stderr,
5216                 "rte_eth_dev_vlan_filter(port_pi=%d, vlan_id=%d, on=%d) failed diag=%d\n",
5217                 port_id, vlan_id, on, diag);
5218         return -1;
5219 }
5220
5221 void
5222 rx_vlan_all_filter_set(portid_t port_id, int on)
5223 {
5224         uint16_t vlan_id;
5225
5226         if (port_id_is_invalid(port_id, ENABLED_WARN))
5227                 return;
5228         for (vlan_id = 0; vlan_id < 4096; vlan_id++) {
5229                 if (rx_vft_set(port_id, vlan_id, on))
5230                         break;
5231         }
5232 }
5233
5234 void
5235 vlan_tpid_set(portid_t port_id, enum rte_vlan_type vlan_type, uint16_t tp_id)
5236 {
5237         int diag;
5238
5239         if (port_id_is_invalid(port_id, ENABLED_WARN))
5240                 return;
5241
5242         diag = rte_eth_dev_set_vlan_ether_type(port_id, vlan_type, tp_id);
5243         if (diag == 0)
5244                 return;
5245
5246         fprintf(stderr,
5247                 "tx_vlan_tpid_set(port_pi=%d, vlan_type=%d, tpid=%d) failed diag=%d\n",
5248                 port_id, vlan_type, tp_id, diag);
5249 }
5250
5251 void
5252 tx_vlan_set(portid_t port_id, uint16_t vlan_id)
5253 {
5254         struct rte_eth_dev_info dev_info;
5255         int ret;
5256
5257         if (vlan_id_is_invalid(vlan_id))
5258                 return;
5259
5260         if (ports[port_id].dev_conf.txmode.offloads &
5261             RTE_ETH_TX_OFFLOAD_QINQ_INSERT) {
5262                 fprintf(stderr, "Error, as QinQ has been enabled.\n");
5263                 return;
5264         }
5265
5266         ret = eth_dev_info_get_print_err(port_id, &dev_info);
5267         if (ret != 0)
5268                 return;
5269
5270         if ((dev_info.tx_offload_capa & RTE_ETH_TX_OFFLOAD_VLAN_INSERT) == 0) {
5271                 fprintf(stderr,
5272                         "Error: vlan insert is not supported by port %d\n",
5273                         port_id);
5274                 return;
5275         }
5276
5277         tx_vlan_reset(port_id);
5278         ports[port_id].dev_conf.txmode.offloads |= RTE_ETH_TX_OFFLOAD_VLAN_INSERT;
5279         ports[port_id].tx_vlan_id = vlan_id;
5280 }
5281
5282 void
5283 tx_qinq_set(portid_t port_id, uint16_t vlan_id, uint16_t vlan_id_outer)
5284 {
5285         struct rte_eth_dev_info dev_info;
5286         int ret;
5287
5288         if (vlan_id_is_invalid(vlan_id))
5289                 return;
5290         if (vlan_id_is_invalid(vlan_id_outer))
5291                 return;
5292
5293         ret = eth_dev_info_get_print_err(port_id, &dev_info);
5294         if (ret != 0)
5295                 return;
5296
5297         if ((dev_info.tx_offload_capa & RTE_ETH_TX_OFFLOAD_QINQ_INSERT) == 0) {
5298                 fprintf(stderr,
5299                         "Error: qinq insert not supported by port %d\n",
5300                         port_id);
5301                 return;
5302         }
5303
5304         tx_vlan_reset(port_id);
5305         ports[port_id].dev_conf.txmode.offloads |= (RTE_ETH_TX_OFFLOAD_VLAN_INSERT |
5306                                                     RTE_ETH_TX_OFFLOAD_QINQ_INSERT);
5307         ports[port_id].tx_vlan_id = vlan_id;
5308         ports[port_id].tx_vlan_id_outer = vlan_id_outer;
5309 }
5310
5311 void
5312 tx_vlan_reset(portid_t port_id)
5313 {
5314         ports[port_id].dev_conf.txmode.offloads &=
5315                                 ~(RTE_ETH_TX_OFFLOAD_VLAN_INSERT |
5316                                   RTE_ETH_TX_OFFLOAD_QINQ_INSERT);
5317         ports[port_id].tx_vlan_id = 0;
5318         ports[port_id].tx_vlan_id_outer = 0;
5319 }
5320
5321 void
5322 tx_vlan_pvid_set(portid_t port_id, uint16_t vlan_id, int on)
5323 {
5324         if (port_id_is_invalid(port_id, ENABLED_WARN))
5325                 return;
5326
5327         rte_eth_dev_set_vlan_pvid(port_id, vlan_id, on);
5328 }
5329
5330 void
5331 set_qmap(portid_t port_id, uint8_t is_rx, uint16_t queue_id, uint8_t map_value)
5332 {
5333         int ret;
5334
5335         if (port_id_is_invalid(port_id, ENABLED_WARN))
5336                 return;
5337
5338         if (is_rx ? (rx_queue_id_is_invalid(queue_id)) : (tx_queue_id_is_invalid(queue_id)))
5339                 return;
5340
5341         if (map_value >= RTE_ETHDEV_QUEUE_STAT_CNTRS) {
5342                 fprintf(stderr, "map_value not in required range 0..%d\n",
5343                         RTE_ETHDEV_QUEUE_STAT_CNTRS - 1);
5344                 return;
5345         }
5346
5347         if (!is_rx) { /* tx */
5348                 ret = rte_eth_dev_set_tx_queue_stats_mapping(port_id, queue_id,
5349                                                              map_value);
5350                 if (ret) {
5351                         fprintf(stderr,
5352                                 "failed to set tx queue stats mapping.\n");
5353                         return;
5354                 }
5355         } else { /* rx */
5356                 ret = rte_eth_dev_set_rx_queue_stats_mapping(port_id, queue_id,
5357                                                              map_value);
5358                 if (ret) {
5359                         fprintf(stderr,
5360                                 "failed to set rx queue stats mapping.\n");
5361                         return;
5362                 }
5363         }
5364 }
5365
5366 void
5367 set_xstats_hide_zero(uint8_t on_off)
5368 {
5369         xstats_hide_zero = on_off;
5370 }
5371
5372 void
5373 set_record_core_cycles(uint8_t on_off)
5374 {
5375         record_core_cycles = on_off;
5376 }
5377
5378 void
5379 set_record_burst_stats(uint8_t on_off)
5380 {
5381         record_burst_stats = on_off;
5382 }
5383
5384 static char*
5385 flowtype_to_str(uint16_t flow_type)
5386 {
5387         struct flow_type_info {
5388                 char str[32];
5389                 uint16_t ftype;
5390         };
5391
5392         uint8_t i;
5393         static struct flow_type_info flowtype_str_table[] = {
5394                 {"raw", RTE_ETH_FLOW_RAW},
5395                 {"ipv4", RTE_ETH_FLOW_IPV4},
5396                 {"ipv4-frag", RTE_ETH_FLOW_FRAG_IPV4},
5397                 {"ipv4-tcp", RTE_ETH_FLOW_NONFRAG_IPV4_TCP},
5398                 {"ipv4-udp", RTE_ETH_FLOW_NONFRAG_IPV4_UDP},
5399                 {"ipv4-sctp", RTE_ETH_FLOW_NONFRAG_IPV4_SCTP},
5400                 {"ipv4-other", RTE_ETH_FLOW_NONFRAG_IPV4_OTHER},
5401                 {"ipv6", RTE_ETH_FLOW_IPV6},
5402                 {"ipv6-frag", RTE_ETH_FLOW_FRAG_IPV6},
5403                 {"ipv6-tcp", RTE_ETH_FLOW_NONFRAG_IPV6_TCP},
5404                 {"ipv6-udp", RTE_ETH_FLOW_NONFRAG_IPV6_UDP},
5405                 {"ipv6-sctp", RTE_ETH_FLOW_NONFRAG_IPV6_SCTP},
5406                 {"ipv6-other", RTE_ETH_FLOW_NONFRAG_IPV6_OTHER},
5407                 {"l2_payload", RTE_ETH_FLOW_L2_PAYLOAD},
5408                 {"ipv6-ex", RTE_ETH_FLOW_IPV6_EX},
5409                 {"ipv6-tcp-ex", RTE_ETH_FLOW_IPV6_TCP_EX},
5410                 {"ipv6-udp-ex", RTE_ETH_FLOW_IPV6_UDP_EX},
5411                 {"port", RTE_ETH_FLOW_PORT},
5412                 {"vxlan", RTE_ETH_FLOW_VXLAN},
5413                 {"geneve", RTE_ETH_FLOW_GENEVE},
5414                 {"nvgre", RTE_ETH_FLOW_NVGRE},
5415                 {"vxlan-gpe", RTE_ETH_FLOW_VXLAN_GPE},
5416                 {"gtpu", RTE_ETH_FLOW_GTPU},
5417         };
5418
5419         for (i = 0; i < RTE_DIM(flowtype_str_table); i++) {
5420                 if (flowtype_str_table[i].ftype == flow_type)
5421                         return flowtype_str_table[i].str;
5422         }
5423
5424         return NULL;
5425 }
5426
5427 #if defined(RTE_NET_I40E) || defined(RTE_NET_IXGBE)
5428
5429 static inline void
5430 print_fdir_mask(struct rte_eth_fdir_masks *mask)
5431 {
5432         printf("\n    vlan_tci: 0x%04x", rte_be_to_cpu_16(mask->vlan_tci_mask));
5433
5434         if (fdir_conf.mode == RTE_FDIR_MODE_PERFECT_TUNNEL)
5435                 printf(", mac_addr: 0x%02x, tunnel_type: 0x%01x,"
5436                         " tunnel_id: 0x%08x",
5437                         mask->mac_addr_byte_mask, mask->tunnel_type_mask,
5438                         rte_be_to_cpu_32(mask->tunnel_id_mask));
5439         else if (fdir_conf.mode != RTE_FDIR_MODE_PERFECT_MAC_VLAN) {
5440                 printf(", src_ipv4: 0x%08x, dst_ipv4: 0x%08x",
5441                         rte_be_to_cpu_32(mask->ipv4_mask.src_ip),
5442                         rte_be_to_cpu_32(mask->ipv4_mask.dst_ip));
5443
5444                 printf("\n    src_port: 0x%04x, dst_port: 0x%04x",
5445                         rte_be_to_cpu_16(mask->src_port_mask),
5446                         rte_be_to_cpu_16(mask->dst_port_mask));
5447
5448                 printf("\n    src_ipv6: 0x%08x,0x%08x,0x%08x,0x%08x",
5449                         rte_be_to_cpu_32(mask->ipv6_mask.src_ip[0]),
5450                         rte_be_to_cpu_32(mask->ipv6_mask.src_ip[1]),
5451                         rte_be_to_cpu_32(mask->ipv6_mask.src_ip[2]),
5452                         rte_be_to_cpu_32(mask->ipv6_mask.src_ip[3]));
5453
5454                 printf("\n    dst_ipv6: 0x%08x,0x%08x,0x%08x,0x%08x",
5455                         rte_be_to_cpu_32(mask->ipv6_mask.dst_ip[0]),
5456                         rte_be_to_cpu_32(mask->ipv6_mask.dst_ip[1]),
5457                         rte_be_to_cpu_32(mask->ipv6_mask.dst_ip[2]),
5458                         rte_be_to_cpu_32(mask->ipv6_mask.dst_ip[3]));
5459         }
5460
5461         printf("\n");
5462 }
5463
5464 static inline void
5465 print_fdir_flex_payload(struct rte_eth_fdir_flex_conf *flex_conf, uint32_t num)
5466 {
5467         struct rte_eth_flex_payload_cfg *cfg;
5468         uint32_t i, j;
5469
5470         for (i = 0; i < flex_conf->nb_payloads; i++) {
5471                 cfg = &flex_conf->flex_set[i];
5472                 if (cfg->type == RTE_ETH_RAW_PAYLOAD)
5473                         printf("\n    RAW:  ");
5474                 else if (cfg->type == RTE_ETH_L2_PAYLOAD)
5475                         printf("\n    L2_PAYLOAD:  ");
5476                 else if (cfg->type == RTE_ETH_L3_PAYLOAD)
5477                         printf("\n    L3_PAYLOAD:  ");
5478                 else if (cfg->type == RTE_ETH_L4_PAYLOAD)
5479                         printf("\n    L4_PAYLOAD:  ");
5480                 else
5481                         printf("\n    UNKNOWN PAYLOAD(%u):  ", cfg->type);
5482                 for (j = 0; j < num; j++)
5483                         printf("  %-5u", cfg->src_offset[j]);
5484         }
5485         printf("\n");
5486 }
5487
5488 static inline void
5489 print_fdir_flex_mask(struct rte_eth_fdir_flex_conf *flex_conf, uint32_t num)
5490 {
5491         struct rte_eth_fdir_flex_mask *mask;
5492         uint32_t i, j;
5493         char *p;
5494
5495         for (i = 0; i < flex_conf->nb_flexmasks; i++) {
5496                 mask = &flex_conf->flex_mask[i];
5497                 p = flowtype_to_str(mask->flow_type);
5498                 printf("\n    %s:\t", p ? p : "unknown");
5499                 for (j = 0; j < num; j++)
5500                         printf(" %02x", mask->mask[j]);
5501         }
5502         printf("\n");
5503 }
5504
5505 static inline void
5506 print_fdir_flow_type(uint32_t flow_types_mask)
5507 {
5508         int i;
5509         char *p;
5510
5511         for (i = RTE_ETH_FLOW_UNKNOWN; i < RTE_ETH_FLOW_MAX; i++) {
5512                 if (!(flow_types_mask & (1 << i)))
5513                         continue;
5514                 p = flowtype_to_str(i);
5515                 if (p)
5516                         printf(" %s", p);
5517                 else
5518                         printf(" unknown");
5519         }
5520         printf("\n");
5521 }
5522
5523 static int
5524 get_fdir_info(portid_t port_id, struct rte_eth_fdir_info *fdir_info,
5525                     struct rte_eth_fdir_stats *fdir_stat)
5526 {
5527         int ret = -ENOTSUP;
5528
5529 #ifdef RTE_NET_I40E
5530         if (ret == -ENOTSUP) {
5531                 ret = rte_pmd_i40e_get_fdir_info(port_id, fdir_info);
5532                 if (!ret)
5533                         ret = rte_pmd_i40e_get_fdir_stats(port_id, fdir_stat);
5534         }
5535 #endif
5536 #ifdef RTE_NET_IXGBE
5537         if (ret == -ENOTSUP) {
5538                 ret = rte_pmd_ixgbe_get_fdir_info(port_id, fdir_info);
5539                 if (!ret)
5540                         ret = rte_pmd_ixgbe_get_fdir_stats(port_id, fdir_stat);
5541         }
5542 #endif
5543         switch (ret) {
5544         case 0:
5545                 break;
5546         case -ENOTSUP:
5547                 fprintf(stderr, "\n FDIR is not supported on port %-2d\n",
5548                         port_id);
5549                 break;
5550         default:
5551                 fprintf(stderr, "programming error: (%s)\n", strerror(-ret));
5552                 break;
5553         }
5554         return ret;
5555 }
5556
5557 void
5558 fdir_get_infos(portid_t port_id)
5559 {
5560         struct rte_eth_fdir_stats fdir_stat;
5561         struct rte_eth_fdir_info fdir_info;
5562
5563         static const char *fdir_stats_border = "########################";
5564
5565         if (port_id_is_invalid(port_id, ENABLED_WARN))
5566                 return;
5567
5568         memset(&fdir_info, 0, sizeof(fdir_info));
5569         memset(&fdir_stat, 0, sizeof(fdir_stat));
5570         if (get_fdir_info(port_id, &fdir_info, &fdir_stat))
5571                 return;
5572
5573         printf("\n  %s FDIR infos for port %-2d     %s\n",
5574                fdir_stats_border, port_id, fdir_stats_border);
5575         printf("  MODE: ");
5576         if (fdir_info.mode == RTE_FDIR_MODE_PERFECT)
5577                 printf("  PERFECT\n");
5578         else if (fdir_info.mode == RTE_FDIR_MODE_PERFECT_MAC_VLAN)
5579                 printf("  PERFECT-MAC-VLAN\n");
5580         else if (fdir_info.mode == RTE_FDIR_MODE_PERFECT_TUNNEL)
5581                 printf("  PERFECT-TUNNEL\n");
5582         else if (fdir_info.mode == RTE_FDIR_MODE_SIGNATURE)
5583                 printf("  SIGNATURE\n");
5584         else
5585                 printf("  DISABLE\n");
5586         if (fdir_info.mode != RTE_FDIR_MODE_PERFECT_MAC_VLAN
5587                 && fdir_info.mode != RTE_FDIR_MODE_PERFECT_TUNNEL) {
5588                 printf("  SUPPORTED FLOW TYPE: ");
5589                 print_fdir_flow_type(fdir_info.flow_types_mask[0]);
5590         }
5591         printf("  FLEX PAYLOAD INFO:\n");
5592         printf("  max_len:       %-10"PRIu32"  payload_limit: %-10"PRIu32"\n"
5593                "  payload_unit:  %-10"PRIu32"  payload_seg:   %-10"PRIu32"\n"
5594                "  bitmask_unit:  %-10"PRIu32"  bitmask_num:   %-10"PRIu32"\n",
5595                 fdir_info.max_flexpayload, fdir_info.flex_payload_limit,
5596                 fdir_info.flex_payload_unit,
5597                 fdir_info.max_flex_payload_segment_num,
5598                 fdir_info.flex_bitmask_unit, fdir_info.max_flex_bitmask_num);
5599         printf("  MASK: ");
5600         print_fdir_mask(&fdir_info.mask);
5601         if (fdir_info.flex_conf.nb_payloads > 0) {
5602                 printf("  FLEX PAYLOAD SRC OFFSET:");
5603                 print_fdir_flex_payload(&fdir_info.flex_conf, fdir_info.max_flexpayload);
5604         }
5605         if (fdir_info.flex_conf.nb_flexmasks > 0) {
5606                 printf("  FLEX MASK CFG:");
5607                 print_fdir_flex_mask(&fdir_info.flex_conf, fdir_info.max_flexpayload);
5608         }
5609         printf("  guarant_count: %-10"PRIu32"  best_count:    %"PRIu32"\n",
5610                fdir_stat.guarant_cnt, fdir_stat.best_cnt);
5611         printf("  guarant_space: %-10"PRIu32"  best_space:    %"PRIu32"\n",
5612                fdir_info.guarant_spc, fdir_info.best_spc);
5613         printf("  collision:     %-10"PRIu32"  free:          %"PRIu32"\n"
5614                "  maxhash:       %-10"PRIu32"  maxlen:        %"PRIu32"\n"
5615                "  add:           %-10"PRIu64"  remove:        %"PRIu64"\n"
5616                "  f_add:         %-10"PRIu64"  f_remove:      %"PRIu64"\n",
5617                fdir_stat.collision, fdir_stat.free,
5618                fdir_stat.maxhash, fdir_stat.maxlen,
5619                fdir_stat.add, fdir_stat.remove,
5620                fdir_stat.f_add, fdir_stat.f_remove);
5621         printf("  %s############################%s\n",
5622                fdir_stats_border, fdir_stats_border);
5623 }
5624
5625 #endif /* RTE_NET_I40E || RTE_NET_IXGBE */
5626
5627 void
5628 fdir_set_flex_mask(portid_t port_id, struct rte_eth_fdir_flex_mask *cfg)
5629 {
5630         struct rte_port *port;
5631         struct rte_eth_fdir_flex_conf *flex_conf;
5632         int i, idx = 0;
5633
5634         port = &ports[port_id];
5635         flex_conf = &port->dev_conf.fdir_conf.flex_conf;
5636         for (i = 0; i < RTE_ETH_FLOW_MAX; i++) {
5637                 if (cfg->flow_type == flex_conf->flex_mask[i].flow_type) {
5638                         idx = i;
5639                         break;
5640                 }
5641         }
5642         if (i >= RTE_ETH_FLOW_MAX) {
5643                 if (flex_conf->nb_flexmasks < RTE_DIM(flex_conf->flex_mask)) {
5644                         idx = flex_conf->nb_flexmasks;
5645                         flex_conf->nb_flexmasks++;
5646                 } else {
5647                         fprintf(stderr,
5648                                 "The flex mask table is full. Can not set flex mask for flow_type(%u).",
5649                                 cfg->flow_type);
5650                         return;
5651                 }
5652         }
5653         rte_memcpy(&flex_conf->flex_mask[idx],
5654                          cfg,
5655                          sizeof(struct rte_eth_fdir_flex_mask));
5656 }
5657
5658 void
5659 fdir_set_flex_payload(portid_t port_id, struct rte_eth_flex_payload_cfg *cfg)
5660 {
5661         struct rte_port *port;
5662         struct rte_eth_fdir_flex_conf *flex_conf;
5663         int i, idx = 0;
5664
5665         port = &ports[port_id];
5666         flex_conf = &port->dev_conf.fdir_conf.flex_conf;
5667         for (i = 0; i < RTE_ETH_PAYLOAD_MAX; i++) {
5668                 if (cfg->type == flex_conf->flex_set[i].type) {
5669                         idx = i;
5670                         break;
5671                 }
5672         }
5673         if (i >= RTE_ETH_PAYLOAD_MAX) {
5674                 if (flex_conf->nb_payloads < RTE_DIM(flex_conf->flex_set)) {
5675                         idx = flex_conf->nb_payloads;
5676                         flex_conf->nb_payloads++;
5677                 } else {
5678                         fprintf(stderr,
5679                                 "The flex payload table is full. Can not set flex payload for type(%u).",
5680                                 cfg->type);
5681                         return;
5682                 }
5683         }
5684         rte_memcpy(&flex_conf->flex_set[idx],
5685                          cfg,
5686                          sizeof(struct rte_eth_flex_payload_cfg));
5687
5688 }
5689
5690 void
5691 set_vf_traffic(portid_t port_id, uint8_t is_rx, uint16_t vf, uint8_t on)
5692 {
5693 #ifdef RTE_NET_IXGBE
5694         int diag;
5695
5696         if (is_rx)
5697                 diag = rte_pmd_ixgbe_set_vf_rx(port_id, vf, on);
5698         else
5699                 diag = rte_pmd_ixgbe_set_vf_tx(port_id, vf, on);
5700
5701         if (diag == 0)
5702                 return;
5703         fprintf(stderr,
5704                 "rte_pmd_ixgbe_set_vf_%s for port_id=%d failed diag=%d\n",
5705                 is_rx ? "rx" : "tx", port_id, diag);
5706         return;
5707 #endif
5708         fprintf(stderr, "VF %s setting not supported for port %d\n",
5709                 is_rx ? "Rx" : "Tx", port_id);
5710         RTE_SET_USED(vf);
5711         RTE_SET_USED(on);
5712 }
5713
5714 int
5715 set_queue_rate_limit(portid_t port_id, uint16_t queue_idx, uint16_t rate)
5716 {
5717         int diag;
5718         struct rte_eth_link link;
5719         int ret;
5720
5721         if (port_id_is_invalid(port_id, ENABLED_WARN))
5722                 return 1;
5723         ret = eth_link_get_nowait_print_err(port_id, &link);
5724         if (ret < 0)
5725                 return 1;
5726         if (link.link_speed != RTE_ETH_SPEED_NUM_UNKNOWN &&
5727             rate > link.link_speed) {
5728                 fprintf(stderr,
5729                         "Invalid rate value:%u bigger than link speed: %u\n",
5730                         rate, link.link_speed);
5731                 return 1;
5732         }
5733         diag = rte_eth_set_queue_rate_limit(port_id, queue_idx, rate);
5734         if (diag == 0)
5735                 return diag;
5736         fprintf(stderr,
5737                 "rte_eth_set_queue_rate_limit for port_id=%d failed diag=%d\n",
5738                 port_id, diag);
5739         return diag;
5740 }
5741
5742 int
5743 set_vf_rate_limit(portid_t port_id, uint16_t vf, uint16_t rate, uint64_t q_msk)
5744 {
5745         int diag = -ENOTSUP;
5746
5747         RTE_SET_USED(vf);
5748         RTE_SET_USED(rate);
5749         RTE_SET_USED(q_msk);
5750
5751 #ifdef RTE_NET_IXGBE
5752         if (diag == -ENOTSUP)
5753                 diag = rte_pmd_ixgbe_set_vf_rate_limit(port_id, vf, rate,
5754                                                        q_msk);
5755 #endif
5756 #ifdef RTE_NET_BNXT
5757         if (diag == -ENOTSUP)
5758                 diag = rte_pmd_bnxt_set_vf_rate_limit(port_id, vf, rate, q_msk);
5759 #endif
5760         if (diag == 0)
5761                 return diag;
5762
5763         fprintf(stderr,
5764                 "%s for port_id=%d failed diag=%d\n",
5765                 __func__, port_id, diag);
5766         return diag;
5767 }
5768
5769 /*
5770  * Functions to manage the set of filtered Multicast MAC addresses.
5771  *
5772  * A pool of filtered multicast MAC addresses is associated with each port.
5773  * The pool is allocated in chunks of MCAST_POOL_INC multicast addresses.
5774  * The address of the pool and the number of valid multicast MAC addresses
5775  * recorded in the pool are stored in the fields "mc_addr_pool" and
5776  * "mc_addr_nb" of the "rte_port" data structure.
5777  *
5778  * The function "rte_eth_dev_set_mc_addr_list" of the PMDs API imposes
5779  * to be supplied a contiguous array of multicast MAC addresses.
5780  * To comply with this constraint, the set of multicast addresses recorded
5781  * into the pool are systematically compacted at the beginning of the pool.
5782  * Hence, when a multicast address is removed from the pool, all following
5783  * addresses, if any, are copied back to keep the set contiguous.
5784  */
5785 #define MCAST_POOL_INC 32
5786
5787 static int
5788 mcast_addr_pool_extend(struct rte_port *port)
5789 {
5790         struct rte_ether_addr *mc_pool;
5791         size_t mc_pool_size;
5792
5793         /*
5794          * If a free entry is available at the end of the pool, just
5795          * increment the number of recorded multicast addresses.
5796          */
5797         if ((port->mc_addr_nb % MCAST_POOL_INC) != 0) {
5798                 port->mc_addr_nb++;
5799                 return 0;
5800         }
5801
5802         /*
5803          * [re]allocate a pool with MCAST_POOL_INC more entries.
5804          * The previous test guarantees that port->mc_addr_nb is a multiple
5805          * of MCAST_POOL_INC.
5806          */
5807         mc_pool_size = sizeof(struct rte_ether_addr) * (port->mc_addr_nb +
5808                                                     MCAST_POOL_INC);
5809         mc_pool = (struct rte_ether_addr *) realloc(port->mc_addr_pool,
5810                                                 mc_pool_size);
5811         if (mc_pool == NULL) {
5812                 fprintf(stderr,
5813                         "allocation of pool of %u multicast addresses failed\n",
5814                         port->mc_addr_nb + MCAST_POOL_INC);
5815                 return -ENOMEM;
5816         }
5817
5818         port->mc_addr_pool = mc_pool;
5819         port->mc_addr_nb++;
5820         return 0;
5821
5822 }
5823
5824 static void
5825 mcast_addr_pool_append(struct rte_port *port, struct rte_ether_addr *mc_addr)
5826 {
5827         if (mcast_addr_pool_extend(port) != 0)
5828                 return;
5829         rte_ether_addr_copy(mc_addr, &port->mc_addr_pool[port->mc_addr_nb - 1]);
5830 }
5831
5832 static void
5833 mcast_addr_pool_remove(struct rte_port *port, uint32_t addr_idx)
5834 {
5835         port->mc_addr_nb--;
5836         if (addr_idx == port->mc_addr_nb) {
5837                 /* No need to recompact the set of multicast addresses. */
5838                 if (port->mc_addr_nb == 0) {
5839                         /* free the pool of multicast addresses. */
5840                         free(port->mc_addr_pool);
5841                         port->mc_addr_pool = NULL;
5842                 }
5843                 return;
5844         }
5845         memmove(&port->mc_addr_pool[addr_idx],
5846                 &port->mc_addr_pool[addr_idx + 1],
5847                 sizeof(struct rte_ether_addr) * (port->mc_addr_nb - addr_idx));
5848 }
5849
5850 static int
5851 eth_port_multicast_addr_list_set(portid_t port_id)
5852 {
5853         struct rte_port *port;
5854         int diag;
5855
5856         port = &ports[port_id];
5857         diag = rte_eth_dev_set_mc_addr_list(port_id, port->mc_addr_pool,
5858                                             port->mc_addr_nb);
5859         if (diag < 0)
5860                 fprintf(stderr,
5861                         "rte_eth_dev_set_mc_addr_list(port=%d, nb=%u) failed. diag=%d\n",
5862                         port_id, port->mc_addr_nb, diag);
5863
5864         return diag;
5865 }
5866
5867 void
5868 mcast_addr_add(portid_t port_id, struct rte_ether_addr *mc_addr)
5869 {
5870         struct rte_port *port;
5871         uint32_t i;
5872
5873         if (port_id_is_invalid(port_id, ENABLED_WARN))
5874                 return;
5875
5876         port = &ports[port_id];
5877
5878         /*
5879          * Check that the added multicast MAC address is not already recorded
5880          * in the pool of multicast addresses.
5881          */
5882         for (i = 0; i < port->mc_addr_nb; i++) {
5883                 if (rte_is_same_ether_addr(mc_addr, &port->mc_addr_pool[i])) {
5884                         fprintf(stderr,
5885                                 "multicast address already filtered by port\n");
5886                         return;
5887                 }
5888         }
5889
5890         mcast_addr_pool_append(port, mc_addr);
5891         if (eth_port_multicast_addr_list_set(port_id) < 0)
5892                 /* Rollback on failure, remove the address from the pool */
5893                 mcast_addr_pool_remove(port, i);
5894 }
5895
5896 void
5897 mcast_addr_remove(portid_t port_id, struct rte_ether_addr *mc_addr)
5898 {
5899         struct rte_port *port;
5900         uint32_t i;
5901
5902         if (port_id_is_invalid(port_id, ENABLED_WARN))
5903                 return;
5904
5905         port = &ports[port_id];
5906
5907         /*
5908          * Search the pool of multicast MAC addresses for the removed address.
5909          */
5910         for (i = 0; i < port->mc_addr_nb; i++) {
5911                 if (rte_is_same_ether_addr(mc_addr, &port->mc_addr_pool[i]))
5912                         break;
5913         }
5914         if (i == port->mc_addr_nb) {
5915                 fprintf(stderr, "multicast address not filtered by port %d\n",
5916                         port_id);
5917                 return;
5918         }
5919
5920         mcast_addr_pool_remove(port, i);
5921         if (eth_port_multicast_addr_list_set(port_id) < 0)
5922                 /* Rollback on failure, add the address back into the pool */
5923                 mcast_addr_pool_append(port, mc_addr);
5924 }
5925
5926 void
5927 port_dcb_info_display(portid_t port_id)
5928 {
5929         struct rte_eth_dcb_info dcb_info;
5930         uint16_t i;
5931         int ret;
5932         static const char *border = "================";
5933
5934         if (port_id_is_invalid(port_id, ENABLED_WARN))
5935                 return;
5936
5937         ret = rte_eth_dev_get_dcb_info(port_id, &dcb_info);
5938         if (ret) {
5939                 fprintf(stderr, "\n Failed to get dcb infos on port %-2d\n",
5940                         port_id);
5941                 return;
5942         }
5943         printf("\n  %s DCB infos for port %-2d  %s\n", border, port_id, border);
5944         printf("  TC NUMBER: %d\n", dcb_info.nb_tcs);
5945         printf("\n  TC :        ");
5946         for (i = 0; i < dcb_info.nb_tcs; i++)
5947                 printf("\t%4d", i);
5948         printf("\n  Priority :  ");
5949         for (i = 0; i < dcb_info.nb_tcs; i++)
5950                 printf("\t%4d", dcb_info.prio_tc[i]);
5951         printf("\n  BW percent :");
5952         for (i = 0; i < dcb_info.nb_tcs; i++)
5953                 printf("\t%4d%%", dcb_info.tc_bws[i]);
5954         printf("\n  RXQ base :  ");
5955         for (i = 0; i < dcb_info.nb_tcs; i++)
5956                 printf("\t%4d", dcb_info.tc_queue.tc_rxq[0][i].base);
5957         printf("\n  RXQ number :");
5958         for (i = 0; i < dcb_info.nb_tcs; i++)
5959                 printf("\t%4d", dcb_info.tc_queue.tc_rxq[0][i].nb_queue);
5960         printf("\n  TXQ base :  ");
5961         for (i = 0; i < dcb_info.nb_tcs; i++)
5962                 printf("\t%4d", dcb_info.tc_queue.tc_txq[0][i].base);
5963         printf("\n  TXQ number :");
5964         for (i = 0; i < dcb_info.nb_tcs; i++)
5965                 printf("\t%4d", dcb_info.tc_queue.tc_txq[0][i].nb_queue);
5966         printf("\n");
5967 }
5968
5969 uint8_t *
5970 open_file(const char *file_path, uint32_t *size)
5971 {
5972         int fd = open(file_path, O_RDONLY);
5973         off_t pkg_size;
5974         uint8_t *buf = NULL;
5975         int ret = 0;
5976         struct stat st_buf;
5977
5978         if (size)
5979                 *size = 0;
5980
5981         if (fd == -1) {
5982                 fprintf(stderr, "%s: Failed to open %s\n", __func__, file_path);
5983                 return buf;
5984         }
5985
5986         if ((fstat(fd, &st_buf) != 0) || (!S_ISREG(st_buf.st_mode))) {
5987                 close(fd);
5988                 fprintf(stderr, "%s: File operations failed\n", __func__);
5989                 return buf;
5990         }
5991
5992         pkg_size = st_buf.st_size;
5993         if (pkg_size < 0) {
5994                 close(fd);
5995                 fprintf(stderr, "%s: File operations failed\n", __func__);
5996                 return buf;
5997         }
5998
5999         buf = (uint8_t *)malloc(pkg_size);
6000         if (!buf) {
6001                 close(fd);
6002                 fprintf(stderr, "%s: Failed to malloc memory\n", __func__);
6003                 return buf;
6004         }
6005
6006         ret = read(fd, buf, pkg_size);
6007         if (ret < 0) {
6008                 close(fd);
6009                 fprintf(stderr, "%s: File read operation failed\n", __func__);
6010                 close_file(buf);
6011                 return NULL;
6012         }
6013
6014         if (size)
6015                 *size = pkg_size;
6016
6017         close(fd);
6018
6019         return buf;
6020 }
6021
6022 int
6023 save_file(const char *file_path, uint8_t *buf, uint32_t size)
6024 {
6025         FILE *fh = fopen(file_path, "wb");
6026
6027         if (fh == NULL) {
6028                 fprintf(stderr, "%s: Failed to open %s\n", __func__, file_path);
6029                 return -1;
6030         }
6031
6032         if (fwrite(buf, 1, size, fh) != size) {
6033                 fclose(fh);
6034                 fprintf(stderr, "%s: File write operation failed\n", __func__);
6035                 return -1;
6036         }
6037
6038         fclose(fh);
6039
6040         return 0;
6041 }
6042
6043 int
6044 close_file(uint8_t *buf)
6045 {
6046         if (buf) {
6047                 free((void *)buf);
6048                 return 0;
6049         }
6050
6051         return -1;
6052 }
6053
6054 void
6055 port_queue_region_info_display(portid_t port_id, void *buf)
6056 {
6057 #ifdef RTE_NET_I40E
6058         uint16_t i, j;
6059         struct rte_pmd_i40e_queue_regions *info =
6060                 (struct rte_pmd_i40e_queue_regions *)buf;
6061         static const char *queue_region_info_stats_border = "-------";
6062
6063         if (!info->queue_region_number)
6064                 printf("there is no region has been set before");
6065
6066         printf("\n      %s All queue region info for port=%2d %s",
6067                         queue_region_info_stats_border, port_id,
6068                         queue_region_info_stats_border);
6069         printf("\n      queue_region_number: %-14u \n",
6070                         info->queue_region_number);
6071
6072         for (i = 0; i < info->queue_region_number; i++) {
6073                 printf("\n      region_id: %-14u queue_number: %-14u "
6074                         "queue_start_index: %-14u \n",
6075                         info->region[i].region_id,
6076                         info->region[i].queue_num,
6077                         info->region[i].queue_start_index);
6078
6079                 printf("  user_priority_num is  %-14u :",
6080                                         info->region[i].user_priority_num);
6081                 for (j = 0; j < info->region[i].user_priority_num; j++)
6082                         printf(" %-14u ", info->region[i].user_priority[j]);
6083
6084                 printf("\n      flowtype_num is  %-14u :",
6085                                 info->region[i].flowtype_num);
6086                 for (j = 0; j < info->region[i].flowtype_num; j++)
6087                         printf(" %-14u ", info->region[i].hw_flowtype[j]);
6088         }
6089 #else
6090         RTE_SET_USED(port_id);
6091         RTE_SET_USED(buf);
6092 #endif
6093
6094         printf("\n\n");
6095 }
6096
6097 void
6098 show_macs(portid_t port_id)
6099 {
6100         char buf[RTE_ETHER_ADDR_FMT_SIZE];
6101         struct rte_eth_dev_info dev_info;
6102         int32_t i, rc, num_macs = 0;
6103
6104         if (eth_dev_info_get_print_err(port_id, &dev_info))
6105                 return;
6106
6107         struct rte_ether_addr addr[dev_info.max_mac_addrs];
6108         rc = rte_eth_macaddrs_get(port_id, addr, dev_info.max_mac_addrs);
6109         if (rc < 0)
6110                 return;
6111
6112         for (i = 0; i < rc; i++) {
6113
6114                 /* skip zero address */
6115                 if (rte_is_zero_ether_addr(&addr[i]))
6116                         continue;
6117
6118                 num_macs++;
6119         }
6120
6121         printf("Number of MAC address added: %d\n", num_macs);
6122
6123         for (i = 0; i < rc; i++) {
6124
6125                 /* skip zero address */
6126                 if (rte_is_zero_ether_addr(&addr[i]))
6127                         continue;
6128
6129                 rte_ether_format_addr(buf, RTE_ETHER_ADDR_FMT_SIZE, &addr[i]);
6130                 printf("  %s\n", buf);
6131         }
6132 }
6133
6134 void
6135 show_mcast_macs(portid_t port_id)
6136 {
6137         char buf[RTE_ETHER_ADDR_FMT_SIZE];
6138         struct rte_ether_addr *addr;
6139         struct rte_port *port;
6140         uint32_t i;
6141
6142         port = &ports[port_id];
6143
6144         printf("Number of Multicast MAC address added: %d\n", port->mc_addr_nb);
6145
6146         for (i = 0; i < port->mc_addr_nb; i++) {
6147                 addr = &port->mc_addr_pool[i];
6148
6149                 rte_ether_format_addr(buf, RTE_ETHER_ADDR_FMT_SIZE, addr);
6150                 printf("  %s\n", buf);
6151         }
6152 }