app/test-pmd/config.c

   1 /*-
   2  *   BSD LICENSE
   3  *
   4  *   Copyright(c) 2010-2014 Intel Corporation. All rights reserved.
   5  *   All rights reserved.
   6  *
   7  *   Redistribution and use in source and binary forms, with or without
   8  *   modification, are permitted provided that the following conditions
   9  *   are met:
  10  *
  11  *     * Redistributions of source code must retain the above copyright
  12  *       notice, this list of conditions and the following disclaimer.
  13  *     * Redistributions in binary form must reproduce the above copyright
  14  *       notice, this list of conditions and the following disclaimer in
  15  *       the documentation and/or other materials provided with the
  16  *       distribution.
  17  *     * Neither the name of Intel Corporation nor the names of its
  18  *       contributors may be used to endorse or promote products derived
  19  *       from this software without specific prior written permission.
  20  *
  21  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  22  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  23  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  24  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  25  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  26  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  27  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  28  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  29  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  30  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  31  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  32  */
  33 /*   BSD LICENSE
  34  *
  35  *   Copyright 2013-2014 6WIND S.A.
  36  *
  37  *   Redistribution and use in source and binary forms, with or without
  38  *   modification, are permitted provided that the following conditions
  39  *   are met:
  40  *
  41  *     * Redistributions of source code must retain the above copyright
  42  *       notice, this list of conditions and the following disclaimer.
  43  *     * Redistributions in binary form must reproduce the above copyright
  44  *       notice, this list of conditions and the following disclaimer in
  45  *       the documentation and/or other materials provided with the
  46  *       distribution.
  47  *     * Neither the name of 6WIND S.A. nor the names of its
  48  *       contributors may be used to endorse or promote products derived
  49  *       from this software without specific prior written permission.
  50  *
  51  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  52  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  53  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
  54  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
  55  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
  56  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
  57  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  58  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  59  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  60  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
  61  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  62  */
  63
  64 #include <stdarg.h>
  65 #include <errno.h>
  66 #include <stdio.h>
  67 #include <string.h>
  68 #include <stdarg.h>
  69 #include <stdint.h>
  70 #include <inttypes.h>
  71
  72 #include <sys/queue.h>
  73
  74 #include <rte_common.h>
  75 #include <rte_byteorder.h>
  76 #include <rte_debug.h>
  77 #include <rte_log.h>
  78 #include <rte_memory.h>
  79 #include <rte_memcpy.h>
  80 #include <rte_memzone.h>
  81 #include <rte_launch.h>
  82 #include <rte_eal.h>
  83 #include <rte_per_lcore.h>
  84 #include <rte_lcore.h>
  85 #include <rte_atomic.h>
  86 #include <rte_branch_prediction.h>
  87 #include <rte_ring.h>
  88 #include <rte_mempool.h>
  89 #include <rte_mbuf.h>
  90 #include <rte_interrupts.h>
  91 #include <rte_pci.h>
  92 #include <rte_ether.h>
  93 #include <rte_ethdev.h>
  94 #include <rte_string_fns.h>
  95
  96 #include "testpmd.h"
  97
  98 static char *flowtype_to_str(uint16_t flow_type);
  99
 100 struct rss_type_info {
 101         char str[32];
 102         uint64_t rss_type;
 103 };
 104
 105 static const struct rss_type_info rss_type_table[] = {
 106         { "ipv4", ETH_RSS_IPV4 },
 107         { "ipv4-frag", ETH_RSS_FRAG_IPV4 },
 108         { "ipv4-tcp", ETH_RSS_NONFRAG_IPV4_TCP },
 109         { "ipv4-udp", ETH_RSS_NONFRAG_IPV4_UDP },
 110         { "ipv4-sctp", ETH_RSS_NONFRAG_IPV4_SCTP },
 111         { "ipv4-other", ETH_RSS_NONFRAG_IPV4_OTHER },
 112         { "ipv6", ETH_RSS_IPV6 },
 113         { "ipv6-frag", ETH_RSS_FRAG_IPV6 },
 114         { "ipv6-tcp", ETH_RSS_NONFRAG_IPV6_TCP },
 115         { "ipv6-udp", ETH_RSS_NONFRAG_IPV6_UDP },
 116         { "ipv6-sctp", ETH_RSS_NONFRAG_IPV6_SCTP },
 117         { "ipv6-other", ETH_RSS_NONFRAG_IPV6_OTHER },
 118         { "l2-payload", ETH_RSS_L2_PAYLOAD },
 119         { "ipv6-ex", ETH_RSS_IPV6_EX },
 120         { "ipv6-tcp-ex", ETH_RSS_IPV6_TCP_EX },
 121         { "ipv6-udp-ex", ETH_RSS_IPV6_UDP_EX },
 122 };
 123
 124 static void
 125 print_ethaddr(const char *name, struct ether_addr *eth_addr)
 126 {
 127         char buf[ETHER_ADDR_FMT_SIZE];
 128         ether_format_addr(buf, ETHER_ADDR_FMT_SIZE, eth_addr);
 129         printf("%s%s", name, buf);
 130 }
 131
 132 void
 133 nic_stats_display(portid_t port_id)
 134 {
 135         struct rte_eth_stats stats;
 136         struct rte_port *port = &ports[port_id];
 137         uint8_t i;
 138         portid_t pid;
 139
 140         static const char *nic_stats_border = "########################";
 141
 142         if (port_id_is_invalid(port_id, ENABLED_WARN)) {
 143                 printf("Valid port range is [0");
 144                 FOREACH_PORT(pid, ports)
 145                         printf(", %d", pid);
 146                 printf("]\n");
 147                 return;
 148         }
 149         rte_eth_stats_get(port_id, &stats);
 150         printf("\n  %s NIC statistics for port %-2d %s\n",
 151                nic_stats_border, port_id, nic_stats_border);
 152
 153         if ((!port->rx_queue_stats_mapping_enabled) && (!port->tx_queue_stats_mapping_enabled)) {
 154                 printf("  RX-packets: %-10"PRIu64" RX-missed: %-10"PRIu64" RX-bytes:  "
 155                        "%-"PRIu64"\n",
 156                        stats.ipackets, stats.imissed, stats.ibytes);
 157                 printf("  RX-badcrc:  %-10"PRIu64" RX-badlen: %-10"PRIu64" RX-errors: "
 158                        "%-"PRIu64"\n",
 159                        stats.ibadcrc, stats.ibadlen, stats.ierrors);
 160                 printf("  RX-nombuf:  %-10"PRIu64"\n",
 161                        stats.rx_nombuf);
 162                 printf("  TX-packets: %-10"PRIu64" TX-errors: %-10"PRIu64" TX-bytes:  "
 163                        "%-"PRIu64"\n",
 164                        stats.opackets, stats.oerrors, stats.obytes);
 165         }
 166         else {
 167                 printf("  RX-packets:              %10"PRIu64"    RX-errors: %10"PRIu64
 168                        "    RX-bytes: %10"PRIu64"\n",
 169                        stats.ipackets, stats.ierrors, stats.ibytes);
 170                 printf("  RX-badcrc:               %10"PRIu64"    RX-badlen: %10"PRIu64
 171                        "  RX-errors:  %10"PRIu64"\n",
 172                        stats.ibadcrc, stats.ibadlen, stats.ierrors);
 173                 printf("  RX-nombuf:               %10"PRIu64"\n",
 174                        stats.rx_nombuf);
 175                 printf("  TX-packets:              %10"PRIu64"    TX-errors: %10"PRIu64
 176                        "    TX-bytes: %10"PRIu64"\n",
 177                        stats.opackets, stats.oerrors, stats.obytes);
 178         }
 179
 180         /* stats fdir */
 181         if (fdir_conf.mode != RTE_FDIR_MODE_NONE)
 182                 printf("  Fdirmiss:   %-10"PRIu64" Fdirmatch: %-10"PRIu64"\n",
 183                        stats.fdirmiss,
 184                        stats.fdirmatch);
 185
 186         if (port->rx_queue_stats_mapping_enabled) {
 187                 printf("\n");
 188                 for (i = 0; i < RTE_ETHDEV_QUEUE_STAT_CNTRS; i++) {
 189                         printf("  Stats reg %2d RX-packets: %10"PRIu64
 190                                "    RX-errors: %10"PRIu64
 191                                "    RX-bytes: %10"PRIu64"\n",
 192                                i, stats.q_ipackets[i], stats.q_errors[i], stats.q_ibytes[i]);
 193                 }
 194         }
 195         if (port->tx_queue_stats_mapping_enabled) {
 196                 printf("\n");
 197                 for (i = 0; i < RTE_ETHDEV_QUEUE_STAT_CNTRS; i++) {
 198                         printf("  Stats reg %2d TX-packets: %10"PRIu64
 199                                "                             TX-bytes: %10"PRIu64"\n",
 200                                i, stats.q_opackets[i], stats.q_obytes[i]);
 201                 }
 202         }
 203
 204         /* Display statistics of XON/XOFF pause frames, if any. */
 205         if ((stats.tx_pause_xon  | stats.rx_pause_xon |
 206              stats.tx_pause_xoff | stats.rx_pause_xoff) > 0) {
 207                 printf("  RX-XOFF:    %-10"PRIu64" RX-XON:    %-10"PRIu64"\n",
 208                        stats.rx_pause_xoff, stats.rx_pause_xon);
 209                 printf("  TX-XOFF:    %-10"PRIu64" TX-XON:    %-10"PRIu64"\n",
 210                        stats.tx_pause_xoff, stats.tx_pause_xon);
 211         }
 212         printf("  %s############################%s\n",
 213                nic_stats_border, nic_stats_border);
 214 }
 215
 216 void
 217 nic_stats_clear(portid_t port_id)
 218 {
 219         portid_t pid;
 220
 221         if (port_id_is_invalid(port_id, ENABLED_WARN)) {
 222                 printf("Valid port range is [0");
 223                 FOREACH_PORT(pid, ports)
 224                         printf(", %d", pid);
 225                 printf("]\n");
 226                 return;
 227         }
 228         rte_eth_stats_reset(port_id);
 229         printf("\n  NIC statistics for port %d cleared\n", port_id);
 230 }
 231
 232 void
 233 nic_xstats_display(portid_t port_id)
 234 {
 235         struct rte_eth_xstats *xstats;
 236         int len, ret, i;
 237
 238         printf("###### NIC extended statistics for port %-2d\n", port_id);
 239
 240         len = rte_eth_xstats_get(port_id, NULL, 0);
 241         if (len < 0) {
 242                 printf("Cannot get xstats count\n");
 243                 return;
 244         }
 245         xstats = malloc(sizeof(xstats[0]) * len);
 246         if (xstats == NULL) {
 247                 printf("Cannot allocate memory for xstats\n");
 248                 return;
 249         }
 250         ret = rte_eth_xstats_get(port_id, xstats, len);
 251         if (ret < 0 || ret > len) {
 252                 printf("Cannot get xstats\n");
 253                 free(xstats);
 254                 return;
 255         }
 256         for (i = 0; i < len; i++)
 257                 printf("%s: %"PRIu64"\n", xstats[i].name, xstats[i].value);
 258         free(xstats);
 259 }
 260
 261 void
 262 nic_xstats_clear(portid_t port_id)
 263 {
 264         rte_eth_xstats_reset(port_id);
 265 }
 266
 267 void
 268 nic_stats_mapping_display(portid_t port_id)
 269 {
 270         struct rte_port *port = &ports[port_id];
 271         uint16_t i;
 272         portid_t pid;
 273
 274         static const char *nic_stats_mapping_border = "########################";
 275
 276         if (port_id_is_invalid(port_id, ENABLED_WARN)) {
 277                 printf("Valid port range is [0");
 278                 FOREACH_PORT(pid, ports)
 279                         printf(", %d", pid);
 280                 printf("]\n");
 281                 return;
 282         }
 283
 284         if ((!port->rx_queue_stats_mapping_enabled) && (!port->tx_queue_stats_mapping_enabled)) {
 285                 printf("Port id %d - either does not support queue statistic mapping or"
 286                        " no queue statistic mapping set\n", port_id);
 287                 return;
 288         }
 289
 290         printf("\n  %s NIC statistics mapping for port %-2d %s\n",
 291                nic_stats_mapping_border, port_id, nic_stats_mapping_border);
 292
 293         if (port->rx_queue_stats_mapping_enabled) {
 294                 for (i = 0; i < nb_rx_queue_stats_mappings; i++) {
 295                         if (rx_queue_stats_mappings[i].port_id == port_id) {
 296                                 printf("  RX-queue %2d mapped to Stats Reg %2d\n",
 297                                        rx_queue_stats_mappings[i].queue_id,
 298                                        rx_queue_stats_mappings[i].stats_counter_id);
 299                         }
 300                 }
 301                 printf("\n");
 302         }
 303
 304
 305         if (port->tx_queue_stats_mapping_enabled) {
 306                 for (i = 0; i < nb_tx_queue_stats_mappings; i++) {
 307                         if (tx_queue_stats_mappings[i].port_id == port_id) {
 308                                 printf("  TX-queue %2d mapped to Stats Reg %2d\n",
 309                                        tx_queue_stats_mappings[i].queue_id,
 310                                        tx_queue_stats_mappings[i].stats_counter_id);
 311                         }
 312                 }
 313         }
 314
 315         printf("  %s####################################%s\n",
 316                nic_stats_mapping_border, nic_stats_mapping_border);
 317 }
 318
 319 void
 320 port_infos_display(portid_t port_id)
 321 {
 322         struct rte_port *port;
 323         struct ether_addr mac_addr;
 324         struct rte_eth_link link;
 325         struct rte_eth_dev_info dev_info;
 326         int vlan_offload;
 327         struct rte_mempool * mp;
 328         static const char *info_border = "*********************";
 329         portid_t pid;
 330
 331         if (port_id_is_invalid(port_id, ENABLED_WARN)) {
 332                 printf("Valid port range is [0");
 333                 FOREACH_PORT(pid, ports)
 334                         printf(", %d", pid);
 335                 printf("]\n");
 336                 return;
 337         }
 338         port = &ports[port_id];
 339         rte_eth_link_get_nowait(port_id, &link);
 340         printf("\n%s Infos for port %-2d %s\n",
 341                info_border, port_id, info_border);
 342         rte_eth_macaddr_get(port_id, &mac_addr);
 343         print_ethaddr("MAC address: ", &mac_addr);
 344         printf("\nConnect to socket: %u", port->socket_id);
 345
 346         if (port_numa[port_id] != NUMA_NO_CONFIG) {
 347                 mp = mbuf_pool_find(port_numa[port_id]);
 348                 if (mp)
 349                         printf("\nmemory allocation on the socket: %d",
 350                                                         port_numa[port_id]);
 351         } else
 352                 printf("\nmemory allocation on the socket: %u",port->socket_id);
 353
 354         printf("\nLink status: %s\n", (link.link_status) ? ("up") : ("down"));
 355         printf("Link speed: %u Mbps\n", (unsigned) link.link_speed);
 356         printf("Link duplex: %s\n", (link.link_duplex == ETH_LINK_FULL_DUPLEX) ?
 357                ("full-duplex") : ("half-duplex"));
 358         printf("Promiscuous mode: %s\n",
 359                rte_eth_promiscuous_get(port_id) ? "enabled" : "disabled");
 360         printf("Allmulticast mode: %s\n",
 361                rte_eth_allmulticast_get(port_id) ? "enabled" : "disabled");
 362         printf("Maximum number of MAC addresses: %u\n",
 363                (unsigned int)(port->dev_info.max_mac_addrs));
 364         printf("Maximum number of MAC addresses of hash filtering: %u\n",
 365                (unsigned int)(port->dev_info.max_hash_mac_addrs));
 366
 367         vlan_offload = rte_eth_dev_get_vlan_offload(port_id);
 368         if (vlan_offload >= 0){
 369                 printf("VLAN offload: \n");
 370                 if (vlan_offload & ETH_VLAN_STRIP_OFFLOAD)
 371                         printf("  strip on \n");
 372                 else
 373                         printf("  strip off \n");
 374
 375                 if (vlan_offload & ETH_VLAN_FILTER_OFFLOAD)
 376                         printf("  filter on \n");
 377                 else
 378                         printf("  filter off \n");
 379
 380                 if (vlan_offload & ETH_VLAN_EXTEND_OFFLOAD)
 381                         printf("  qinq(extend) on \n");
 382                 else
 383                         printf("  qinq(extend) off \n");
 384         }
 385
 386         memset(&dev_info, 0, sizeof(dev_info));
 387         rte_eth_dev_info_get(port_id, &dev_info);
 388         if (dev_info.hash_key_size > 0)
 389                 printf("Hash key size in bytes: %u\n", dev_info.hash_key_size);
 390         if (dev_info.reta_size > 0)
 391                 printf("Redirection table size: %u\n", dev_info.reta_size);
 392         if (!dev_info.flow_type_rss_offloads)
 393                 printf("No flow type is supported.\n");
 394         else {
 395                 uint16_t i;
 396                 char *p;
 397
 398                 printf("Supported flow types:\n");
 399                 for (i = RTE_ETH_FLOW_UNKNOWN + 1; i < RTE_ETH_FLOW_MAX;
 400                                                                 i++) {
 401                         if (!(dev_info.flow_type_rss_offloads & (1ULL << i)))
 402                                 continue;
 403                         p = flowtype_to_str(i);
 404                         printf("  %s\n", (p ? p : "unknown"));
 405                 }
 406         }
 407 }
 408
 409 int
 410 port_id_is_invalid(portid_t port_id, enum print_warning warning)
 411 {
 412         if (port_id == (portid_t)RTE_PORT_ALL)
 413                 return 0;
 414
 415         if (port_id < RTE_MAX_ETHPORTS && ports[port_id].enabled)
 416                 return 0;
 417
 418         if (warning == ENABLED_WARN)
 419                 printf("Invalid port %d\n", port_id);
 420
 421         return 1;
 422 }
 423
 424 static int
 425 vlan_id_is_invalid(uint16_t vlan_id)
 426 {
 427         if (vlan_id < 4096)
 428                 return 0;
 429         printf("Invalid vlan_id %d (must be < 4096)\n", vlan_id);
 430         return 1;
 431 }
 432
 433 static int
 434 port_reg_off_is_invalid(portid_t port_id, uint32_t reg_off)
 435 {
 436         uint64_t pci_len;
 437
 438         if (reg_off & 0x3) {
 439                 printf("Port register offset 0x%X not aligned on a 4-byte "
 440                        "boundary\n",
 441                        (unsigned)reg_off);
 442                 return 1;
 443         }
 444         pci_len = ports[port_id].dev_info.pci_dev->mem_resource[0].len;
 445         if (reg_off >= pci_len) {
 446                 printf("Port %d: register offset %u (0x%X) out of port PCI "
 447                        "resource (length=%"PRIu64")\n",
 448                        port_id, (unsigned)reg_off, (unsigned)reg_off,  pci_len);
 449                 return 1;
 450         }
 451         return 0;
 452 }
 453
 454 static int
 455 reg_bit_pos_is_invalid(uint8_t bit_pos)
 456 {
 457         if (bit_pos <= 31)
 458                 return 0;
 459         printf("Invalid bit position %d (must be <= 31)\n", bit_pos);
 460         return 1;
 461 }
 462
 463 #define display_port_and_reg_off(port_id, reg_off) \
 464         printf("port %d PCI register at offset 0x%X: ", (port_id), (reg_off))
 465
 466 static inline void
 467 display_port_reg_value(portid_t port_id, uint32_t reg_off, uint32_t reg_v)
 468 {
 469         display_port_and_reg_off(port_id, (unsigned)reg_off);
 470         printf("0x%08X (%u)\n", (unsigned)reg_v, (unsigned)reg_v);
 471 }
 472
 473 void
 474 port_reg_bit_display(portid_t port_id, uint32_t reg_off, uint8_t bit_x)
 475 {
 476         uint32_t reg_v;
 477
 478
 479         if (port_id_is_invalid(port_id, ENABLED_WARN))
 480                 return;
 481         if (port_reg_off_is_invalid(port_id, reg_off))
 482                 return;
 483         if (reg_bit_pos_is_invalid(bit_x))
 484                 return;
 485         reg_v = port_id_pci_reg_read(port_id, reg_off);
 486         display_port_and_reg_off(port_id, (unsigned)reg_off);
 487         printf("bit %d=%d\n", bit_x, (int) ((reg_v & (1 << bit_x)) >> bit_x));
 488 }
 489
 490 void
 491 port_reg_bit_field_display(portid_t port_id, uint32_t reg_off,
 492                            uint8_t bit1_pos, uint8_t bit2_pos)
 493 {
 494         uint32_t reg_v;
 495         uint8_t  l_bit;
 496         uint8_t  h_bit;
 497
 498         if (port_id_is_invalid(port_id, ENABLED_WARN))
 499                 return;
 500         if (port_reg_off_is_invalid(port_id, reg_off))
 501                 return;
 502         if (reg_bit_pos_is_invalid(bit1_pos))
 503                 return;
 504         if (reg_bit_pos_is_invalid(bit2_pos))
 505                 return;
 506         if (bit1_pos > bit2_pos)
 507                 l_bit = bit2_pos, h_bit = bit1_pos;
 508         else
 509                 l_bit = bit1_pos, h_bit = bit2_pos;
 510
 511         reg_v = port_id_pci_reg_read(port_id, reg_off);
 512         reg_v >>= l_bit;
 513         if (h_bit < 31)
 514                 reg_v &= ((1 << (h_bit - l_bit + 1)) - 1);
 515         display_port_and_reg_off(port_id, (unsigned)reg_off);
 516         printf("bits[%d, %d]=0x%0*X (%u)\n", l_bit, h_bit,
 517                ((h_bit - l_bit) / 4) + 1, (unsigned)reg_v, (unsigned)reg_v);
 518 }
 519
 520 void
 521 port_reg_display(portid_t port_id, uint32_t reg_off)
 522 {
 523         uint32_t reg_v;
 524
 525         if (port_id_is_invalid(port_id, ENABLED_WARN))
 526                 return;
 527         if (port_reg_off_is_invalid(port_id, reg_off))
 528                 return;
 529         reg_v = port_id_pci_reg_read(port_id, reg_off);
 530         display_port_reg_value(port_id, reg_off, reg_v);
 531 }
 532
 533 void
 534 port_reg_bit_set(portid_t port_id, uint32_t reg_off, uint8_t bit_pos,
 535                  uint8_t bit_v)
 536 {
 537         uint32_t reg_v;
 538
 539         if (port_id_is_invalid(port_id, ENABLED_WARN))
 540                 return;
 541         if (port_reg_off_is_invalid(port_id, reg_off))
 542                 return;
 543         if (reg_bit_pos_is_invalid(bit_pos))
 544                 return;
 545         if (bit_v > 1) {
 546                 printf("Invalid bit value %d (must be 0 or 1)\n", (int) bit_v);
 547                 return;
 548         }
 549         reg_v = port_id_pci_reg_read(port_id, reg_off);
 550         if (bit_v == 0)
 551                 reg_v &= ~(1 << bit_pos);
 552         else
 553                 reg_v |= (1 << bit_pos);
 554         port_id_pci_reg_write(port_id, reg_off, reg_v);
 555         display_port_reg_value(port_id, reg_off, reg_v);
 556 }
 557
 558 void
 559 port_reg_bit_field_set(portid_t port_id, uint32_t reg_off,
 560                        uint8_t bit1_pos, uint8_t bit2_pos, uint32_t value)
 561 {
 562         uint32_t max_v;
 563         uint32_t reg_v;
 564         uint8_t  l_bit;
 565         uint8_t  h_bit;
 566
 567         if (port_id_is_invalid(port_id, ENABLED_WARN))
 568                 return;
 569         if (port_reg_off_is_invalid(port_id, reg_off))
 570                 return;
 571         if (reg_bit_pos_is_invalid(bit1_pos))
 572                 return;
 573         if (reg_bit_pos_is_invalid(bit2_pos))
 574                 return;
 575         if (bit1_pos > bit2_pos)
 576                 l_bit = bit2_pos, h_bit = bit1_pos;
 577         else
 578                 l_bit = bit1_pos, h_bit = bit2_pos;
 579
 580         if ((h_bit - l_bit) < 31)
 581                 max_v = (1 << (h_bit - l_bit + 1)) - 1;
 582         else
 583                 max_v = 0xFFFFFFFF;
 584
 585         if (value > max_v) {
 586                 printf("Invalid value %u (0x%x) must be < %u (0x%x)\n",
 587                                 (unsigned)value, (unsigned)value,
 588                                 (unsigned)max_v, (unsigned)max_v);
 589                 return;
 590         }
 591         reg_v = port_id_pci_reg_read(port_id, reg_off);
 592         reg_v &= ~(max_v << l_bit); /* Keep unchanged bits */
 593         reg_v |= (value << l_bit); /* Set changed bits */
 594         port_id_pci_reg_write(port_id, reg_off, reg_v);
 595         display_port_reg_value(port_id, reg_off, reg_v);
 596 }
 597
 598 void
 599 port_reg_set(portid_t port_id, uint32_t reg_off, uint32_t reg_v)
 600 {
 601         if (port_id_is_invalid(port_id, ENABLED_WARN))
 602                 return;
 603         if (port_reg_off_is_invalid(port_id, reg_off))
 604                 return;
 605         port_id_pci_reg_write(port_id, reg_off, reg_v);
 606         display_port_reg_value(port_id, reg_off, reg_v);
 607 }
 608
 609 void
 610 port_mtu_set(portid_t port_id, uint16_t mtu)
 611 {
 612         int diag;
 613
 614         if (port_id_is_invalid(port_id, ENABLED_WARN))
 615                 return;
 616         diag = rte_eth_dev_set_mtu(port_id, mtu);
 617         if (diag == 0)
 618                 return;
 619         printf("Set MTU failed. diag=%d\n", diag);
 620 }
 621
 622 /*
 623  * RX/TX ring descriptors display functions.
 624  */
 625 int
 626 rx_queue_id_is_invalid(queueid_t rxq_id)
 627 {
 628         if (rxq_id < nb_rxq)
 629                 return 0;
 630         printf("Invalid RX queue %d (must be < nb_rxq=%d)\n", rxq_id, nb_rxq);
 631         return 1;
 632 }
 633
 634 int
 635 tx_queue_id_is_invalid(queueid_t txq_id)
 636 {
 637         if (txq_id < nb_txq)
 638                 return 0;
 639         printf("Invalid TX queue %d (must be < nb_rxq=%d)\n", txq_id, nb_txq);
 640         return 1;
 641 }
 642
 643 static int
 644 rx_desc_id_is_invalid(uint16_t rxdesc_id)
 645 {
 646         if (rxdesc_id < nb_rxd)
 647                 return 0;
 648         printf("Invalid RX descriptor %d (must be < nb_rxd=%d)\n",
 649                rxdesc_id, nb_rxd);
 650         return 1;
 651 }
 652
 653 static int
 654 tx_desc_id_is_invalid(uint16_t txdesc_id)
 655 {
 656         if (txdesc_id < nb_txd)
 657                 return 0;
 658         printf("Invalid TX descriptor %d (must be < nb_txd=%d)\n",
 659                txdesc_id, nb_txd);
 660         return 1;
 661 }
 662
 663 static const struct rte_memzone *
 664 ring_dma_zone_lookup(const char *ring_name, uint8_t port_id, uint16_t q_id)
 665 {
 666         char mz_name[RTE_MEMZONE_NAMESIZE];
 667         const struct rte_memzone *mz;
 668
 669         snprintf(mz_name, sizeof(mz_name), "%s_%s_%d_%d",
 670                  ports[port_id].dev_info.driver_name, ring_name, port_id, q_id);
 671         mz = rte_memzone_lookup(mz_name);
 672         if (mz == NULL)
 673                 printf("%s ring memory zoneof (port %d, queue %d) not"
 674                        "found (zone name = %s\n",
 675                        ring_name, port_id, q_id, mz_name);
 676         return (mz);
 677 }
 678
 679 union igb_ring_dword {
 680         uint64_t dword;
 681         struct {
 682 #if RTE_BYTE_ORDER == RTE_BIG_ENDIAN
 683                 uint32_t lo;
 684                 uint32_t hi;
 685 #else
 686                 uint32_t hi;
 687                 uint32_t lo;
 688 #endif
 689         } words;
 690 };
 691
 692 struct igb_ring_desc_32_bytes {
 693         union igb_ring_dword lo_dword;
 694         union igb_ring_dword hi_dword;
 695         union igb_ring_dword resv1;
 696         union igb_ring_dword resv2;
 697 };
 698
 699 struct igb_ring_desc_16_bytes {
 700         union igb_ring_dword lo_dword;
 701         union igb_ring_dword hi_dword;
 702 };
 703
 704 static void
 705 ring_rxd_display_dword(union igb_ring_dword dword)
 706 {
 707         printf("    0x%08X - 0x%08X\n", (unsigned)dword.words.lo,
 708                                         (unsigned)dword.words.hi);
 709 }
 710
 711 static void
 712 ring_rx_descriptor_display(const struct rte_memzone *ring_mz,
 713 #ifndef RTE_LIBRTE_I40E_16BYTE_RX_DESC
 714                            uint8_t port_id,
 715 #else
 716                            __rte_unused uint8_t port_id,
 717 #endif
 718                            uint16_t desc_id)
 719 {
 720         struct igb_ring_desc_16_bytes *ring =
 721                 (struct igb_ring_desc_16_bytes *)ring_mz->addr;
 722 #ifndef RTE_LIBRTE_I40E_16BYTE_RX_DESC
 723         struct rte_eth_dev_info dev_info;
 724
 725         memset(&dev_info, 0, sizeof(dev_info));
 726         rte_eth_dev_info_get(port_id, &dev_info);
 727         if (strstr(dev_info.driver_name, "i40e") != NULL) {
 728                 /* 32 bytes RX descriptor, i40e only */
 729                 struct igb_ring_desc_32_bytes *ring =
 730                         (struct igb_ring_desc_32_bytes *)ring_mz->addr;
 731                 ring[desc_id].lo_dword.dword =
 732                         rte_le_to_cpu_64(ring[desc_id].lo_dword.dword);
 733                 ring_rxd_display_dword(ring[desc_id].lo_dword);
 734                 ring[desc_id].hi_dword.dword =
 735                         rte_le_to_cpu_64(ring[desc_id].hi_dword.dword);
 736                 ring_rxd_display_dword(ring[desc_id].hi_dword);
 737                 ring[desc_id].resv1.dword =
 738                         rte_le_to_cpu_64(ring[desc_id].resv1.dword);
 739                 ring_rxd_display_dword(ring[desc_id].resv1);
 740                 ring[desc_id].resv2.dword =
 741                         rte_le_to_cpu_64(ring[desc_id].resv2.dword);
 742                 ring_rxd_display_dword(ring[desc_id].resv2);
 743
 744                 return;
 745         }
 746 #endif
 747         /* 16 bytes RX descriptor */
 748         ring[desc_id].lo_dword.dword =
 749                 rte_le_to_cpu_64(ring[desc_id].lo_dword.dword);
 750         ring_rxd_display_dword(ring[desc_id].lo_dword);
 751         ring[desc_id].hi_dword.dword =
 752                 rte_le_to_cpu_64(ring[desc_id].hi_dword.dword);
 753         ring_rxd_display_dword(ring[desc_id].hi_dword);
 754 }
 755
 756 static void
 757 ring_tx_descriptor_display(const struct rte_memzone *ring_mz, uint16_t desc_id)
 758 {
 759         struct igb_ring_desc_16_bytes *ring;
 760         struct igb_ring_desc_16_bytes txd;
 761
 762         ring = (struct igb_ring_desc_16_bytes *)ring_mz->addr;
 763         txd.lo_dword.dword = rte_le_to_cpu_64(ring[desc_id].lo_dword.dword);
 764         txd.hi_dword.dword = rte_le_to_cpu_64(ring[desc_id].hi_dword.dword);
 765         printf("    0x%08X - 0x%08X / 0x%08X - 0x%08X\n",
 766                         (unsigned)txd.lo_dword.words.lo,
 767                         (unsigned)txd.lo_dword.words.hi,
 768                         (unsigned)txd.hi_dword.words.lo,
 769                         (unsigned)txd.hi_dword.words.hi);
 770 }
 771
 772 void
 773 rx_ring_desc_display(portid_t port_id, queueid_t rxq_id, uint16_t rxd_id)
 774 {
 775         const struct rte_memzone *rx_mz;
 776
 777         if (port_id_is_invalid(port_id, ENABLED_WARN))
 778                 return;
 779         if (rx_queue_id_is_invalid(rxq_id))
 780                 return;
 781         if (rx_desc_id_is_invalid(rxd_id))
 782                 return;
 783         rx_mz = ring_dma_zone_lookup("rx_ring", port_id, rxq_id);
 784         if (rx_mz == NULL)
 785                 return;
 786         ring_rx_descriptor_display(rx_mz, port_id, rxd_id);
 787 }
 788
 789 void
 790 tx_ring_desc_display(portid_t port_id, queueid_t txq_id, uint16_t txd_id)
 791 {
 792         const struct rte_memzone *tx_mz;
 793
 794         if (port_id_is_invalid(port_id, ENABLED_WARN))
 795                 return;
 796         if (tx_queue_id_is_invalid(txq_id))
 797                 return;
 798         if (tx_desc_id_is_invalid(txd_id))
 799                 return;
 800         tx_mz = ring_dma_zone_lookup("tx_ring", port_id, txq_id);
 801         if (tx_mz == NULL)
 802                 return;
 803         ring_tx_descriptor_display(tx_mz, txd_id);
 804 }
 805
 806 void
 807 fwd_lcores_config_display(void)
 808 {
 809         lcoreid_t lc_id;
 810
 811         printf("List of forwarding lcores:");
 812         for (lc_id = 0; lc_id < nb_cfg_lcores; lc_id++)
 813                 printf(" %2u", fwd_lcores_cpuids[lc_id]);
 814         printf("\n");
 815 }
 816 void
 817 rxtx_config_display(void)
 818 {
 819         printf("  %s packet forwarding - CRC stripping %s - "
 820                "packets/burst=%d\n", cur_fwd_eng->fwd_mode_name,
 821                rx_mode.hw_strip_crc ? "enabled" : "disabled",
 822                nb_pkt_per_burst);
 823
 824         if (cur_fwd_eng == &tx_only_engine)
 825                 printf("  packet len=%u - nb packet segments=%d\n",
 826                                 (unsigned)tx_pkt_length, (int) tx_pkt_nb_segs);
 827
 828         struct rte_eth_rxconf *rx_conf = &ports[0].rx_conf;
 829         struct rte_eth_txconf *tx_conf = &ports[0].tx_conf;
 830
 831         printf("  nb forwarding cores=%d - nb forwarding ports=%d\n",
 832                nb_fwd_lcores, nb_fwd_ports);
 833         printf("  RX queues=%d - RX desc=%d - RX free threshold=%d\n",
 834                nb_rxq, nb_rxd, rx_conf->rx_free_thresh);
 835         printf("  RX threshold registers: pthresh=%d hthresh=%d wthresh=%d\n",
 836                rx_conf->rx_thresh.pthresh, rx_conf->rx_thresh.hthresh,
 837                rx_conf->rx_thresh.wthresh);
 838         printf("  TX queues=%d - TX desc=%d - TX free threshold=%d\n",
 839                nb_txq, nb_txd, tx_conf->tx_free_thresh);
 840         printf("  TX threshold registers: pthresh=%d hthresh=%d wthresh=%d\n",
 841                tx_conf->tx_thresh.pthresh, tx_conf->tx_thresh.hthresh,
 842                tx_conf->tx_thresh.wthresh);
 843         printf("  TX RS bit threshold=%d - TXQ flags=0x%"PRIx32"\n",
 844                tx_conf->tx_rs_thresh, tx_conf->txq_flags);
 845 }
 846
 847 void
 848 port_rss_reta_info(portid_t port_id,
 849                    struct rte_eth_rss_reta_entry64 *reta_conf,
 850                    uint16_t nb_entries)
 851 {
 852         uint16_t i, idx, shift;
 853         int ret;
 854
 855         if (port_id_is_invalid(port_id, ENABLED_WARN))
 856                 return;
 857
 858         ret = rte_eth_dev_rss_reta_query(port_id, reta_conf, nb_entries);
 859         if (ret != 0) {
 860                 printf("Failed to get RSS RETA info, return code = %d\n", ret);
 861                 return;
 862         }
 863
 864         for (i = 0; i < nb_entries; i++) {
 865                 idx = i / RTE_RETA_GROUP_SIZE;
 866                 shift = i % RTE_RETA_GROUP_SIZE;
 867                 if (!(reta_conf[idx].mask & (1ULL << shift)))
 868                         continue;
 869                 printf("RSS RETA configuration: hash index=%u, queue=%u\n",
 870                                         i, reta_conf[idx].reta[shift]);
 871         }
 872 }
 873
 874 /*
 875  * Displays the RSS hash functions of a port, and, optionaly, the RSS hash
 876  * key of the port.
 877  */
 878 void
 879 port_rss_hash_conf_show(portid_t port_id, char rss_info[], int show_rss_key)
 880 {
 881         struct rte_eth_rss_conf rss_conf;
 882         uint8_t rss_key[10 * 4] = "";
 883         uint64_t rss_hf;
 884         uint8_t i;
 885         int diag;
 886
 887         if (port_id_is_invalid(port_id, ENABLED_WARN))
 888                 return;
 889
 890         rss_conf.rss_hf = 0;
 891         for (i = 0; i < RTE_DIM(rss_type_table); i++) {
 892                 if (!strcmp(rss_info, rss_type_table[i].str))
 893                         rss_conf.rss_hf = rss_type_table[i].rss_type;
 894         }
 895
 896         /* Get RSS hash key if asked to display it */
 897         rss_conf.rss_key = (show_rss_key) ? rss_key : NULL;
 898         rss_conf.rss_key_len = sizeof(rss_key);
 899         diag = rte_eth_dev_rss_hash_conf_get(port_id, &rss_conf);
 900         if (diag != 0) {
 901                 switch (diag) {
 902                 case -ENODEV:
 903                         printf("port index %d invalid\n", port_id);
 904                         break;
 905                 case -ENOTSUP:
 906                         printf("operation not supported by device\n");
 907                         break;
 908                 default:
 909                         printf("operation failed - diag=%d\n", diag);
 910                         break;
 911                 }
 912                 return;
 913         }
 914         rss_hf = rss_conf.rss_hf;
 915         if (rss_hf == 0) {
 916                 printf("RSS disabled\n");
 917                 return;
 918         }
 919         printf("RSS functions:\n ");
 920         for (i = 0; i < RTE_DIM(rss_type_table); i++) {
 921                 if (rss_hf & rss_type_table[i].rss_type)
 922                         printf("%s ", rss_type_table[i].str);
 923         }
 924         printf("\n");
 925         if (!show_rss_key)
 926                 return;
 927         printf("RSS key:\n");
 928         for (i = 0; i < sizeof(rss_key); i++)
 929                 printf("%02X", rss_key[i]);
 930         printf("\n");
 931 }
 932
 933 void
 934 port_rss_hash_key_update(portid_t port_id, char rss_type[], uint8_t *hash_key,
 935                          uint hash_key_len)
 936 {
 937         struct rte_eth_rss_conf rss_conf;
 938         int diag;
 939         unsigned int i;
 940
 941         rss_conf.rss_key = NULL;
 942         rss_conf.rss_key_len = hash_key_len;
 943         rss_conf.rss_hf = 0;
 944         for (i = 0; i < RTE_DIM(rss_type_table); i++) {
 945                 if (!strcmp(rss_type_table[i].str, rss_type))
 946                         rss_conf.rss_hf = rss_type_table[i].rss_type;
 947         }
 948         diag = rte_eth_dev_rss_hash_conf_get(port_id, &rss_conf);
 949         if (diag == 0) {
 950                 rss_conf.rss_key = hash_key;
 951                 diag = rte_eth_dev_rss_hash_update(port_id, &rss_conf);
 952         }
 953         if (diag == 0)
 954                 return;
 955
 956         switch (diag) {
 957         case -ENODEV:
 958                 printf("port index %d invalid\n", port_id);
 959                 break;
 960         case -ENOTSUP:
 961                 printf("operation not supported by device\n");
 962                 break;
 963         default:
 964                 printf("operation failed - diag=%d\n", diag);
 965                 break;
 966         }
 967 }
 968
 969 /*
 970  * Setup forwarding configuration for each logical core.
 971  */
 972 static void
 973 setup_fwd_config_of_each_lcore(struct fwd_config *cfg)
 974 {
 975         streamid_t nb_fs_per_lcore;
 976         streamid_t nb_fs;
 977         streamid_t sm_id;
 978         lcoreid_t  nb_extra;
 979         lcoreid_t  nb_fc;
 980         lcoreid_t  nb_lc;
 981         lcoreid_t  lc_id;
 982
 983         nb_fs = cfg->nb_fwd_streams;
 984         nb_fc = cfg->nb_fwd_lcores;
 985         if (nb_fs <= nb_fc) {
 986                 nb_fs_per_lcore = 1;
 987                 nb_extra = 0;
 988         } else {
 989                 nb_fs_per_lcore = (streamid_t) (nb_fs / nb_fc);
 990                 nb_extra = (lcoreid_t) (nb_fs % nb_fc);
 991         }
 992
 993         nb_lc = (lcoreid_t) (nb_fc - nb_extra);
 994         sm_id = 0;
 995         for (lc_id = 0; lc_id < nb_lc; lc_id++) {
 996                 fwd_lcores[lc_id]->stream_idx = sm_id;
 997                 fwd_lcores[lc_id]->stream_nb = nb_fs_per_lcore;
 998                 sm_id = (streamid_t) (sm_id + nb_fs_per_lcore);
 999         }
1000
1001         /*
1002          * Assign extra remaining streams, if any.
1003          */
1004         nb_fs_per_lcore = (streamid_t) (nb_fs_per_lcore + 1);
1005         for (lc_id = 0; lc_id < nb_extra; lc_id++) {
1006                 fwd_lcores[nb_lc + lc_id]->stream_idx = sm_id;
1007                 fwd_lcores[nb_lc + lc_id]->stream_nb = nb_fs_per_lcore;
1008                 sm_id = (streamid_t) (sm_id + nb_fs_per_lcore);
1009         }
1010 }
1011
1012 static void
1013 simple_fwd_config_setup(void)
1014 {
1015         portid_t i;
1016         portid_t j;
1017         portid_t inc = 2;
1018
1019         if (port_topology == PORT_TOPOLOGY_CHAINED ||
1020             port_topology == PORT_TOPOLOGY_LOOP) {
1021                 inc = 1;
1022         } else if (nb_fwd_ports % 2) {
1023                 printf("\nWarning! Cannot handle an odd number of ports "
1024                        "with the current port topology. Configuration "
1025                        "must be changed to have an even number of ports, "
1026                        "or relaunch application with "
1027                        "--port-topology=chained\n\n");
1028         }
1029
1030         cur_fwd_config.nb_fwd_ports = (portid_t) nb_fwd_ports;
1031         cur_fwd_config.nb_fwd_streams =
1032                 (streamid_t) cur_fwd_config.nb_fwd_ports;
1033
1034         /* reinitialize forwarding streams */
1035         init_fwd_streams();
1036
1037         /*
1038          * In the simple forwarding test, the number of forwarding cores
1039          * must be lower or equal to the number of forwarding ports.
1040          */
1041         cur_fwd_config.nb_fwd_lcores = (lcoreid_t) nb_fwd_lcores;
1042         if (cur_fwd_config.nb_fwd_lcores > cur_fwd_config.nb_fwd_ports)
1043                 cur_fwd_config.nb_fwd_lcores =
1044                         (lcoreid_t) cur_fwd_config.nb_fwd_ports;
1045         setup_fwd_config_of_each_lcore(&cur_fwd_config);
1046
1047         for (i = 0; i < cur_fwd_config.nb_fwd_ports; i = (portid_t) (i + inc)) {
1048                 if (port_topology != PORT_TOPOLOGY_LOOP)
1049                         j = (portid_t) ((i + 1) % cur_fwd_config.nb_fwd_ports);
1050                 else
1051                         j = i;
1052                 fwd_streams[i]->rx_port   = fwd_ports_ids[i];
1053                 fwd_streams[i]->rx_queue  = 0;
1054                 fwd_streams[i]->tx_port   = fwd_ports_ids[j];
1055                 fwd_streams[i]->tx_queue  = 0;
1056                 fwd_streams[i]->peer_addr = j;
1057
1058                 if (port_topology == PORT_TOPOLOGY_PAIRED) {
1059                         fwd_streams[j]->rx_port   = fwd_ports_ids[j];
1060                         fwd_streams[j]->rx_queue  = 0;
1061                         fwd_streams[j]->tx_port   = fwd_ports_ids[i];
1062                         fwd_streams[j]->tx_queue  = 0;
1063                         fwd_streams[j]->peer_addr = i;
1064                 }
1065         }
1066 }
1067
1068 /**
1069  * For the RSS forwarding test, each core is assigned on every port a transmit
1070  * queue whose index is the index of the core itself. This approach limits the
1071  * maximumm number of processing cores of the RSS test to the maximum number of
1072  * TX queues supported by the devices.
1073  *
1074  * Each core is assigned a single stream, each stream being composed of
1075  * a RX queue to poll on a RX port for input messages, associated with
1076  * a TX queue of a TX port where to send forwarded packets.
1077  * All packets received on the RX queue of index "RxQj" of the RX port "RxPi"
1078  * are sent on the TX queue "TxQl" of the TX port "TxPk" according to the two
1079  * following rules:
1080  *    - TxPk = (RxPi + 1) if RxPi is even, (RxPi - 1) if RxPi is odd
1081  *    - TxQl = RxQj
1082  */
1083 static void
1084 rss_fwd_config_setup(void)
1085 {
1086         portid_t   rxp;
1087         portid_t   txp;
1088         queueid_t  rxq;
1089         queueid_t  nb_q;
1090         lcoreid_t  lc_id;
1091
1092         nb_q = nb_rxq;
1093         if (nb_q > nb_txq)
1094                 nb_q = nb_txq;
1095         cur_fwd_config.nb_fwd_lcores = (lcoreid_t) nb_fwd_lcores;
1096         cur_fwd_config.nb_fwd_ports = nb_fwd_ports;
1097         cur_fwd_config.nb_fwd_streams =
1098                 (streamid_t) (nb_q * cur_fwd_config.nb_fwd_ports);
1099         if (cur_fwd_config.nb_fwd_streams > cur_fwd_config.nb_fwd_lcores)
1100                 cur_fwd_config.nb_fwd_streams =
1101                         (streamid_t)cur_fwd_config.nb_fwd_lcores;
1102         else
1103                 cur_fwd_config.nb_fwd_lcores =
1104                         (lcoreid_t)cur_fwd_config.nb_fwd_streams;
1105
1106         /* reinitialize forwarding streams */
1107         init_fwd_streams();
1108
1109         setup_fwd_config_of_each_lcore(&cur_fwd_config);
1110         rxp = 0; rxq = 0;
1111         for (lc_id = 0; lc_id < cur_fwd_config.nb_fwd_lcores; lc_id++) {
1112                 struct fwd_stream *fs;
1113
1114                 fs = fwd_streams[lc_id];
1115
1116                 if ((rxp & 0x1) == 0)
1117                         txp = (portid_t) (rxp + 1);
1118                 else
1119                         txp = (portid_t) (rxp - 1);
1120                 /*
1121                  * if we are in loopback, simply send stuff out through the
1122                  * ingress port
1123                  */
1124                 if (port_topology == PORT_TOPOLOGY_LOOP)
1125                         txp = rxp;
1126
1127                 fs->rx_port = fwd_ports_ids[rxp];
1128                 fs->rx_queue = rxq;
1129                 fs->tx_port = fwd_ports_ids[txp];
1130                 fs->tx_queue = rxq;
1131                 fs->peer_addr = fs->tx_port;
1132                 rxq = (queueid_t) (rxq + 1);
1133                 if (rxq < nb_q)
1134                         continue;
1135                 /*
1136                  * rxq == nb_q
1137                  * Restart from RX queue 0 on next RX port
1138                  */
1139                 rxq = 0;
1140                 if (numa_support && (nb_fwd_ports <= (nb_ports >> 1)))
1141                         rxp = (portid_t)
1142                                 (rxp + ((nb_ports >> 1) / nb_fwd_ports));
1143                 else
1144                         rxp = (portid_t) (rxp + 1);
1145         }
1146 }
1147
1148 /*
1149  * In DCB and VT on,the mapping of 128 receive queues to 128 transmit queues.
1150  */
1151 static void
1152 dcb_rxq_2_txq_mapping(queueid_t rxq, queueid_t *txq)
1153 {
1154         if(dcb_q_mapping == DCB_4_TCS_Q_MAPPING) {
1155
1156                 if (rxq < 32)
1157                         /* tc0: 0-31 */
1158                         *txq = rxq;
1159                 else if (rxq < 64) {
1160                         /* tc1: 64-95 */
1161                         *txq =  (uint16_t)(rxq + 32);
1162                 }
1163                 else {
1164                         /* tc2: 96-111;tc3:112-127 */
1165                         *txq =  (uint16_t)(rxq/2 + 64);
1166                 }
1167         }
1168         else {
1169                 if (rxq < 16)
1170                         /* tc0 mapping*/
1171                         *txq = rxq;
1172                 else if (rxq < 32) {
1173                         /* tc1 mapping*/
1174                          *txq = (uint16_t)(rxq + 16);
1175                 }
1176                 else if (rxq < 64) {
1177                         /*tc2,tc3 mapping */
1178                         *txq =  (uint16_t)(rxq + 32);
1179                 }
1180                 else {
1181                         /* tc4,tc5,tc6 and tc7 mapping */
1182                         *txq =  (uint16_t)(rxq/2 + 64);
1183                 }
1184         }
1185 }
1186
1187 /**
1188  * For the DCB forwarding test, each core is assigned on every port multi-transmit
1189  * queue.
1190  *
1191  * Each core is assigned a multi-stream, each stream being composed of
1192  * a RX queue to poll on a RX port for input messages, associated with
1193  * a TX queue of a TX port where to send forwarded packets.
1194  * All packets received on the RX queue of index "RxQj" of the RX port "RxPi"
1195  * are sent on the TX queue "TxQl" of the TX port "TxPk" according to the two
1196  * following rules:
1197  * In VT mode,
1198  *    - TxPk = (RxPi + 1) if RxPi is even, (RxPi - 1) if RxPi is odd
1199  *    - TxQl = RxQj
1200  * In non-VT mode,
1201  *    - TxPk = (RxPi + 1) if RxPi is even, (RxPi - 1) if RxPi is odd
1202  *    There is a mapping of RxQj to TxQl to be required,and the mapping was implemented
1203  *    in dcb_rxq_2_txq_mapping function.
1204  */
1205 static void
1206 dcb_fwd_config_setup(void)
1207 {
1208         portid_t   rxp;
1209         portid_t   txp;
1210         queueid_t  rxq;
1211         queueid_t  nb_q;
1212         lcoreid_t  lc_id;
1213         uint16_t sm_id;
1214
1215         nb_q = nb_rxq;
1216
1217         cur_fwd_config.nb_fwd_lcores = (lcoreid_t) nb_fwd_lcores;
1218         cur_fwd_config.nb_fwd_ports = nb_fwd_ports;
1219         cur_fwd_config.nb_fwd_streams =
1220                 (streamid_t) (nb_q * cur_fwd_config.nb_fwd_ports);
1221
1222         /* reinitialize forwarding streams */
1223         init_fwd_streams();
1224
1225         setup_fwd_config_of_each_lcore(&cur_fwd_config);
1226         rxp = 0; rxq = 0;
1227         for (lc_id = 0; lc_id < cur_fwd_config.nb_fwd_lcores; lc_id++) {
1228                 /* a fwd core can run multi-streams */
1229                 for (sm_id = 0; sm_id < fwd_lcores[lc_id]->stream_nb; sm_id++)
1230                 {
1231                         struct fwd_stream *fs;
1232                         fs = fwd_streams[fwd_lcores[lc_id]->stream_idx + sm_id];
1233                         if ((rxp & 0x1) == 0)
1234                                 txp = (portid_t) (rxp + 1);
1235                         else
1236                                 txp = (portid_t) (rxp - 1);
1237                         fs->rx_port = fwd_ports_ids[rxp];
1238                         fs->rx_queue = rxq;
1239                         fs->tx_port = fwd_ports_ids[txp];
1240                         if (dcb_q_mapping == DCB_VT_Q_MAPPING)
1241                                 fs->tx_queue = rxq;
1242                         else
1243                                 dcb_rxq_2_txq_mapping(rxq, &fs->tx_queue);
1244                         fs->peer_addr = fs->tx_port;
1245                         rxq = (queueid_t) (rxq + 1);
1246                         if (rxq < nb_q)
1247                                 continue;
1248                         rxq = 0;
1249                         if (numa_support && (nb_fwd_ports <= (nb_ports >> 1)))
1250                                 rxp = (portid_t)
1251                                         (rxp + ((nb_ports >> 1) / nb_fwd_ports));
1252                         else
1253                                 rxp = (portid_t) (rxp + 1);
1254                 }
1255         }
1256 }
1257
1258 static void
1259 icmp_echo_config_setup(void)
1260 {
1261         portid_t  rxp;
1262         queueid_t rxq;
1263         lcoreid_t lc_id;
1264         uint16_t  sm_id;
1265
1266         if ((nb_txq * nb_fwd_ports) < nb_fwd_lcores)
1267                 cur_fwd_config.nb_fwd_lcores = (lcoreid_t)
1268                         (nb_txq * nb_fwd_ports);
1269         else
1270                 cur_fwd_config.nb_fwd_lcores = (lcoreid_t) nb_fwd_lcores;
1271         cur_fwd_config.nb_fwd_ports = nb_fwd_ports;
1272         cur_fwd_config.nb_fwd_streams =
1273                 (streamid_t) (nb_rxq * cur_fwd_config.nb_fwd_ports);
1274         if (cur_fwd_config.nb_fwd_streams < cur_fwd_config.nb_fwd_lcores)
1275                 cur_fwd_config.nb_fwd_lcores =
1276                         (lcoreid_t)cur_fwd_config.nb_fwd_streams;
1277         if (verbose_level > 0) {
1278                 printf("%s fwd_cores=%d fwd_ports=%d fwd_streams=%d\n",
1279                        __FUNCTION__,
1280                        cur_fwd_config.nb_fwd_lcores,
1281                        cur_fwd_config.nb_fwd_ports,
1282                        cur_fwd_config.nb_fwd_streams);
1283         }
1284
1285         /* reinitialize forwarding streams */
1286         init_fwd_streams();
1287         setup_fwd_config_of_each_lcore(&cur_fwd_config);
1288         rxp = 0; rxq = 0;
1289         for (lc_id = 0; lc_id < cur_fwd_config.nb_fwd_lcores; lc_id++) {
1290                 if (verbose_level > 0)
1291                         printf("  core=%d: \n", lc_id);
1292                 for (sm_id = 0; sm_id < fwd_lcores[lc_id]->stream_nb; sm_id++) {
1293                         struct fwd_stream *fs;
1294                         fs = fwd_streams[fwd_lcores[lc_id]->stream_idx + sm_id];
1295                         fs->rx_port = fwd_ports_ids[rxp];
1296                         fs->rx_queue = rxq;
1297                         fs->tx_port = fs->rx_port;
1298                         fs->tx_queue = lc_id;
1299                         fs->peer_addr = fs->tx_port;
1300                         if (verbose_level > 0)
1301                                 printf("  stream=%d port=%d rxq=%d txq=%d\n",
1302                                        sm_id, fs->rx_port, fs->rx_queue,
1303                                        fs->tx_queue);
1304                         rxq = (queueid_t) (rxq + 1);
1305                         if (rxq == nb_rxq) {
1306                                 rxq = 0;
1307                                 rxp = (portid_t) (rxp + 1);
1308                         }
1309                 }
1310         }
1311 }
1312
1313 void
1314 fwd_config_setup(void)
1315 {
1316         cur_fwd_config.fwd_eng = cur_fwd_eng;
1317         if (strcmp(cur_fwd_eng->fwd_mode_name, "icmpecho") == 0) {
1318                 icmp_echo_config_setup();
1319                 return;
1320         }
1321         if ((nb_rxq > 1) && (nb_txq > 1)){
1322                 if (dcb_config)
1323                         dcb_fwd_config_setup();
1324                 else
1325                         rss_fwd_config_setup();
1326         }
1327         else
1328                 simple_fwd_config_setup();
1329 }
1330
1331 static void
1332 pkt_fwd_config_display(struct fwd_config *cfg)
1333 {
1334         struct fwd_stream *fs;
1335         lcoreid_t  lc_id;
1336         streamid_t sm_id;
1337
1338         printf("%s packet forwarding - ports=%d - cores=%d - streams=%d - "
1339                 "NUMA support %s, MP over anonymous pages %s\n",
1340                 cfg->fwd_eng->fwd_mode_name,
1341                 cfg->nb_fwd_ports, cfg->nb_fwd_lcores, cfg->nb_fwd_streams,
1342                 numa_support == 1 ? "enabled" : "disabled",
1343                 mp_anon != 0 ? "enabled" : "disabled");
1344
1345         if (strcmp(cfg->fwd_eng->fwd_mode_name, "mac_retry") == 0)
1346                 printf("TX retry num: %u, delay between TX retries: %uus\n",
1347                         burst_tx_retry_num, burst_tx_delay_time);
1348         for (lc_id = 0; lc_id < cfg->nb_fwd_lcores; lc_id++) {
1349                 printf("Logical Core %u (socket %u) forwards packets on "
1350                        "%d streams:",
1351                        fwd_lcores_cpuids[lc_id],
1352                        rte_lcore_to_socket_id(fwd_lcores_cpuids[lc_id]),
1353                        fwd_lcores[lc_id]->stream_nb);
1354                 for (sm_id = 0; sm_id < fwd_lcores[lc_id]->stream_nb; sm_id++) {
1355                         fs = fwd_streams[fwd_lcores[lc_id]->stream_idx + sm_id];
1356                         printf("\n  RX P=%d/Q=%d (socket %u) -> TX "
1357                                "P=%d/Q=%d (socket %u) ",
1358                                fs->rx_port, fs->rx_queue,
1359                                ports[fs->rx_port].socket_id,
1360                                fs->tx_port, fs->tx_queue,
1361                                ports[fs->tx_port].socket_id);
1362                         print_ethaddr("peer=",
1363                                       &peer_eth_addrs[fs->peer_addr]);
1364                 }
1365                 printf("\n");
1366         }
1367         printf("\n");
1368 }
1369
1370
1371 void
1372 fwd_config_display(void)
1373 {
1374         if((dcb_config) && (nb_fwd_lcores == 1)) {
1375                 printf("In DCB mode,the nb forwarding cores should be larger than 1\n");
1376                 return;
1377         }
1378         fwd_config_setup();
1379         pkt_fwd_config_display(&cur_fwd_config);
1380 }
1381
1382 int
1383 set_fwd_lcores_list(unsigned int *lcorelist, unsigned int nb_lc)
1384 {
1385         unsigned int i;
1386         unsigned int lcore_cpuid;
1387         int record_now;
1388
1389         record_now = 0;
1390  again:
1391         for (i = 0; i < nb_lc; i++) {
1392                 lcore_cpuid = lcorelist[i];
1393                 if (! rte_lcore_is_enabled(lcore_cpuid)) {
1394                         printf("lcore %u not enabled\n", lcore_cpuid);
1395                         return -1;
1396                 }
1397                 if (lcore_cpuid == rte_get_master_lcore()) {
1398                         printf("lcore %u cannot be masked on for running "
1399                                "packet forwarding, which is the master lcore "
1400                                "and reserved for command line parsing only\n",
1401                                lcore_cpuid);
1402                         return -1;
1403                 }
1404                 if (record_now)
1405                         fwd_lcores_cpuids[i] = lcore_cpuid;
1406         }
1407         if (record_now == 0) {
1408                 record_now = 1;
1409                 goto again;
1410         }
1411         nb_cfg_lcores = (lcoreid_t) nb_lc;
1412         if (nb_fwd_lcores != (lcoreid_t) nb_lc) {
1413                 printf("previous number of forwarding cores %u - changed to "
1414                        "number of configured cores %u\n",
1415                        (unsigned int) nb_fwd_lcores, nb_lc);
1416                 nb_fwd_lcores = (lcoreid_t) nb_lc;
1417         }
1418
1419         return 0;
1420 }
1421
1422 int
1423 set_fwd_lcores_mask(uint64_t lcoremask)
1424 {
1425         unsigned int lcorelist[64];
1426         unsigned int nb_lc;
1427         unsigned int i;
1428
1429         if (lcoremask == 0) {
1430                 printf("Invalid NULL mask of cores\n");
1431                 return -1;
1432         }
1433         nb_lc = 0;
1434         for (i = 0; i < 64; i++) {
1435                 if (! ((uint64_t)(1ULL << i) & lcoremask))
1436                         continue;
1437                 lcorelist[nb_lc++] = i;
1438         }
1439         return set_fwd_lcores_list(lcorelist, nb_lc);
1440 }
1441
1442 void
1443 set_fwd_lcores_number(uint16_t nb_lc)
1444 {
1445         if (nb_lc > nb_cfg_lcores) {
1446                 printf("nb fwd cores %u > %u (max. number of configured "
1447                        "lcores) - ignored\n",
1448                        (unsigned int) nb_lc, (unsigned int) nb_cfg_lcores);
1449                 return;
1450         }
1451         nb_fwd_lcores = (lcoreid_t) nb_lc;
1452         printf("Number of forwarding cores set to %u\n",
1453                (unsigned int) nb_fwd_lcores);
1454 }
1455
1456 void
1457 set_fwd_ports_list(unsigned int *portlist, unsigned int nb_pt)
1458 {
1459         unsigned int i;
1460         portid_t port_id;
1461         int record_now;
1462
1463         record_now = 0;
1464  again:
1465         for (i = 0; i < nb_pt; i++) {
1466                 port_id = (portid_t) portlist[i];
1467                 if (port_id_is_invalid(port_id, ENABLED_WARN))
1468                         return;
1469                 if (record_now)
1470                         fwd_ports_ids[i] = port_id;
1471         }
1472         if (record_now == 0) {
1473                 record_now = 1;
1474                 goto again;
1475         }
1476         nb_cfg_ports = (portid_t) nb_pt;
1477         if (nb_fwd_ports != (portid_t) nb_pt) {
1478                 printf("previous number of forwarding ports %u - changed to "
1479                        "number of configured ports %u\n",
1480                        (unsigned int) nb_fwd_ports, nb_pt);
1481                 nb_fwd_ports = (portid_t) nb_pt;
1482         }
1483 }
1484
1485 void
1486 set_fwd_ports_mask(uint64_t portmask)
1487 {
1488         unsigned int portlist[64];
1489         unsigned int nb_pt;
1490         unsigned int i;
1491
1492         if (portmask == 0) {
1493                 printf("Invalid NULL mask of ports\n");
1494                 return;
1495         }
1496         nb_pt = 0;
1497         for (i = 0; i < (unsigned)RTE_MIN(64, RTE_MAX_ETHPORTS); i++) {
1498                 if (! ((uint64_t)(1ULL << i) & portmask))
1499                         continue;
1500                 portlist[nb_pt++] = i;
1501         }
1502         set_fwd_ports_list(portlist, nb_pt);
1503 }
1504
1505 void
1506 set_fwd_ports_number(uint16_t nb_pt)
1507 {
1508         if (nb_pt > nb_cfg_ports) {
1509                 printf("nb fwd ports %u > %u (number of configured "
1510                        "ports) - ignored\n",
1511                        (unsigned int) nb_pt, (unsigned int) nb_cfg_ports);
1512                 return;
1513         }
1514         nb_fwd_ports = (portid_t) nb_pt;
1515         printf("Number of forwarding ports set to %u\n",
1516                (unsigned int) nb_fwd_ports);
1517 }
1518
1519 void
1520 set_nb_pkt_per_burst(uint16_t nb)
1521 {
1522         if (nb > MAX_PKT_BURST) {
1523                 printf("nb pkt per burst: %u > %u (maximum packet per burst) "
1524                        " ignored\n",
1525                        (unsigned int) nb, (unsigned int) MAX_PKT_BURST);
1526                 return;
1527         }
1528         nb_pkt_per_burst = nb;
1529         printf("Number of packets per burst set to %u\n",
1530                (unsigned int) nb_pkt_per_burst);
1531 }
1532
1533 void
1534 set_tx_pkt_segments(unsigned *seg_lengths, unsigned nb_segs)
1535 {
1536         uint16_t tx_pkt_len;
1537         unsigned i;
1538
1539         if (nb_segs >= (unsigned) nb_txd) {
1540                 printf("nb segments per TX packets=%u >= nb_txd=%u - ignored\n",
1541                        nb_segs, (unsigned int) nb_txd);
1542                 return;
1543         }
1544
1545         /*
1546          * Check that each segment length is greater or equal than
1547          * the mbuf data sise.
1548          * Check also that the total packet length is greater or equal than the
1549          * size of an empty UDP/IP packet (sizeof(struct ether_hdr) + 20 + 8).
1550          */
1551         tx_pkt_len = 0;
1552         for (i = 0; i < nb_segs; i++) {
1553                 if (seg_lengths[i] > (unsigned) mbuf_data_size) {
1554                         printf("length[%u]=%u > mbuf_data_size=%u - give up\n",
1555                                i, seg_lengths[i], (unsigned) mbuf_data_size);
1556                         return;
1557                 }
1558                 tx_pkt_len = (uint16_t)(tx_pkt_len + seg_lengths[i]);
1559         }
1560         if (tx_pkt_len < (sizeof(struct ether_hdr) + 20 + 8)) {
1561                 printf("total packet length=%u < %d - give up\n",
1562                                 (unsigned) tx_pkt_len,
1563                                 (int)(sizeof(struct ether_hdr) + 20 + 8));
1564                 return;
1565         }
1566
1567         for (i = 0; i < nb_segs; i++)
1568                 tx_pkt_seg_lengths[i] = (uint16_t) seg_lengths[i];
1569
1570         tx_pkt_length  = tx_pkt_len;
1571         tx_pkt_nb_segs = (uint8_t) nb_segs;
1572 }
1573
1574 char*
1575 list_pkt_forwarding_modes(void)
1576 {
1577         static char fwd_modes[128] = "";
1578         const char *separator = "|";
1579         struct fwd_engine *fwd_eng;
1580         unsigned i = 0;
1581
1582         if (strlen (fwd_modes) == 0) {
1583                 while ((fwd_eng = fwd_engines[i++]) != NULL) {
1584                         strcat(fwd_modes, fwd_eng->fwd_mode_name);
1585                         strcat(fwd_modes, separator);
1586                 }
1587                 fwd_modes[strlen(fwd_modes) - strlen(separator)] = '\0';
1588         }
1589
1590         return fwd_modes;
1591 }
1592
1593 void
1594 set_pkt_forwarding_mode(const char *fwd_mode_name)
1595 {
1596         struct fwd_engine *fwd_eng;
1597         unsigned i;
1598
1599         i = 0;
1600         while ((fwd_eng = fwd_engines[i]) != NULL) {
1601                 if (! strcmp(fwd_eng->fwd_mode_name, fwd_mode_name)) {
1602                         printf("Set %s packet forwarding mode\n",
1603                                fwd_mode_name);
1604                         cur_fwd_eng = fwd_eng;
1605                         return;
1606                 }
1607                 i++;
1608         }
1609         printf("Invalid %s packet forwarding mode\n", fwd_mode_name);
1610 }
1611
1612 void
1613 set_verbose_level(uint16_t vb_level)
1614 {
1615         printf("Change verbose level from %u to %u\n",
1616                (unsigned int) verbose_level, (unsigned int) vb_level);
1617         verbose_level = vb_level;
1618 }
1619
1620 void
1621 vlan_extend_set(portid_t port_id, int on)
1622 {
1623         int diag;
1624         int vlan_offload;
1625
1626         if (port_id_is_invalid(port_id, ENABLED_WARN))
1627                 return;
1628
1629         vlan_offload = rte_eth_dev_get_vlan_offload(port_id);
1630
1631         if (on)
1632                 vlan_offload |= ETH_VLAN_EXTEND_OFFLOAD;
1633         else
1634                 vlan_offload &= ~ETH_VLAN_EXTEND_OFFLOAD;
1635
1636         diag = rte_eth_dev_set_vlan_offload(port_id, vlan_offload);
1637         if (diag < 0)
1638                 printf("rx_vlan_extend_set(port_pi=%d, on=%d) failed "
1639                "diag=%d\n", port_id, on, diag);
1640 }
1641
1642 void
1643 rx_vlan_strip_set(portid_t port_id, int on)
1644 {
1645         int diag;
1646         int vlan_offload;
1647
1648         if (port_id_is_invalid(port_id, ENABLED_WARN))
1649                 return;
1650
1651         vlan_offload = rte_eth_dev_get_vlan_offload(port_id);
1652
1653         if (on)
1654                 vlan_offload |= ETH_VLAN_STRIP_OFFLOAD;
1655         else
1656                 vlan_offload &= ~ETH_VLAN_STRIP_OFFLOAD;
1657
1658         diag = rte_eth_dev_set_vlan_offload(port_id, vlan_offload);
1659         if (diag < 0)
1660                 printf("rx_vlan_strip_set(port_pi=%d, on=%d) failed "
1661                "diag=%d\n", port_id, on, diag);
1662 }
1663
1664 void
1665 rx_vlan_strip_set_on_queue(portid_t port_id, uint16_t queue_id, int on)
1666 {
1667         int diag;
1668
1669         if (port_id_is_invalid(port_id, ENABLED_WARN))
1670                 return;
1671
1672         diag = rte_eth_dev_set_vlan_strip_on_queue(port_id, queue_id, on);
1673         if (diag < 0)
1674                 printf("rx_vlan_strip_set_on_queue(port_pi=%d, queue_id=%d, on=%d) failed "
1675                "diag=%d\n", port_id, queue_id, on, diag);
1676 }
1677
1678 void
1679 rx_vlan_filter_set(portid_t port_id, int on)
1680 {
1681         int diag;
1682         int vlan_offload;
1683
1684         if (port_id_is_invalid(port_id, ENABLED_WARN))
1685                 return;
1686
1687         vlan_offload = rte_eth_dev_get_vlan_offload(port_id);
1688
1689         if (on)
1690                 vlan_offload |= ETH_VLAN_FILTER_OFFLOAD;
1691         else
1692                 vlan_offload &= ~ETH_VLAN_FILTER_OFFLOAD;
1693
1694         diag = rte_eth_dev_set_vlan_offload(port_id, vlan_offload);
1695         if (diag < 0)
1696                 printf("rx_vlan_filter_set(port_pi=%d, on=%d) failed "
1697                "diag=%d\n", port_id, on, diag);
1698 }
1699
1700 int
1701 rx_vft_set(portid_t port_id, uint16_t vlan_id, int on)
1702 {
1703         int diag;
1704
1705         if (port_id_is_invalid(port_id, ENABLED_WARN))
1706                 return 1;
1707         if (vlan_id_is_invalid(vlan_id))
1708                 return 1;
1709         diag = rte_eth_dev_vlan_filter(port_id, vlan_id, on);
1710         if (diag == 0)
1711                 return 0;
1712         printf("rte_eth_dev_vlan_filter(port_pi=%d, vlan_id=%d, on=%d) failed "
1713                "diag=%d\n",
1714                port_id, vlan_id, on, diag);
1715         return -1;
1716 }
1717
1718 void
1719 rx_vlan_all_filter_set(portid_t port_id, int on)
1720 {
1721         uint16_t vlan_id;
1722
1723         if (port_id_is_invalid(port_id, ENABLED_WARN))
1724                 return;
1725         for (vlan_id = 0; vlan_id < 4096; vlan_id++) {
1726                 if (rx_vft_set(port_id, vlan_id, on))
1727                         break;
1728         }
1729 }
1730
1731 void
1732 vlan_tpid_set(portid_t port_id, uint16_t tp_id)
1733 {
1734         int diag;
1735         if (port_id_is_invalid(port_id, ENABLED_WARN))
1736                 return;
1737
1738         diag = rte_eth_dev_set_vlan_ether_type(port_id, tp_id);
1739         if (diag == 0)
1740                 return;
1741
1742         printf("tx_vlan_tpid_set(port_pi=%d, tpid=%d) failed "
1743                "diag=%d\n",
1744                port_id, tp_id, diag);
1745 }
1746
1747 void
1748 tx_vlan_set(portid_t port_id, uint16_t vlan_id)
1749 {
1750         if (port_id_is_invalid(port_id, ENABLED_WARN))
1751                 return;
1752         if (vlan_id_is_invalid(vlan_id))
1753                 return;
1754         tx_vlan_reset(port_id);
1755         ports[port_id].tx_ol_flags |= TESTPMD_TX_OFFLOAD_INSERT_VLAN;
1756         ports[port_id].tx_vlan_id = vlan_id;
1757 }
1758
1759 void
1760 tx_qinq_set(portid_t port_id, uint16_t vlan_id, uint16_t vlan_id_outer)
1761 {
1762         if (port_id_is_invalid(port_id, ENABLED_WARN))
1763                 return;
1764         if (vlan_id_is_invalid(vlan_id))
1765                 return;
1766         if (vlan_id_is_invalid(vlan_id_outer))
1767                 return;
1768         tx_vlan_reset(port_id);
1769         ports[port_id].tx_ol_flags |= TESTPMD_TX_OFFLOAD_INSERT_QINQ;
1770         ports[port_id].tx_vlan_id = vlan_id;
1771         ports[port_id].tx_vlan_id_outer = vlan_id_outer;
1772 }
1773
1774 void
1775 tx_vlan_reset(portid_t port_id)
1776 {
1777         if (port_id_is_invalid(port_id, ENABLED_WARN))
1778                 return;
1779         ports[port_id].tx_ol_flags &= ~(TESTPMD_TX_OFFLOAD_INSERT_VLAN |
1780                                 TESTPMD_TX_OFFLOAD_INSERT_QINQ);
1781         ports[port_id].tx_vlan_id = 0;
1782         ports[port_id].tx_vlan_id_outer = 0;
1783 }
1784
1785 void
1786 tx_vlan_pvid_set(portid_t port_id, uint16_t vlan_id, int on)
1787 {
1788         if (port_id_is_invalid(port_id, ENABLED_WARN))
1789                 return;
1790
1791         rte_eth_dev_set_vlan_pvid(port_id, vlan_id, on);
1792 }
1793
1794 void
1795 set_qmap(portid_t port_id, uint8_t is_rx, uint16_t queue_id, uint8_t map_value)
1796 {
1797         uint16_t i;
1798         uint8_t existing_mapping_found = 0;
1799
1800         if (port_id_is_invalid(port_id, ENABLED_WARN))
1801                 return;
1802
1803         if (is_rx ? (rx_queue_id_is_invalid(queue_id)) : (tx_queue_id_is_invalid(queue_id)))
1804                 return;
1805
1806         if (map_value >= RTE_ETHDEV_QUEUE_STAT_CNTRS) {
1807                 printf("map_value not in required range 0..%d\n",
1808                                 RTE_ETHDEV_QUEUE_STAT_CNTRS - 1);
1809                 return;
1810         }
1811
1812         if (!is_rx) { /*then tx*/
1813                 for (i = 0; i < nb_tx_queue_stats_mappings; i++) {
1814                         if ((tx_queue_stats_mappings[i].port_id == port_id) &&
1815                             (tx_queue_stats_mappings[i].queue_id == queue_id)) {
1816                                 tx_queue_stats_mappings[i].stats_counter_id = map_value;
1817                                 existing_mapping_found = 1;
1818                                 break;
1819                         }
1820                 }
1821                 if (!existing_mapping_found) { /* A new additional mapping... */
1822                         tx_queue_stats_mappings[nb_tx_queue_stats_mappings].port_id = port_id;
1823                         tx_queue_stats_mappings[nb_tx_queue_stats_mappings].queue_id = queue_id;
1824                         tx_queue_stats_mappings[nb_tx_queue_stats_mappings].stats_counter_id = map_value;
1825                         nb_tx_queue_stats_mappings++;
1826                 }
1827         }
1828         else { /*rx*/
1829                 for (i = 0; i < nb_rx_queue_stats_mappings; i++) {
1830                         if ((rx_queue_stats_mappings[i].port_id == port_id) &&
1831                             (rx_queue_stats_mappings[i].queue_id == queue_id)) {
1832                                 rx_queue_stats_mappings[i].stats_counter_id = map_value;
1833                                 existing_mapping_found = 1;
1834                                 break;
1835                         }
1836                 }
1837                 if (!existing_mapping_found) { /* A new additional mapping... */
1838                         rx_queue_stats_mappings[nb_rx_queue_stats_mappings].port_id = port_id;
1839                         rx_queue_stats_mappings[nb_rx_queue_stats_mappings].queue_id = queue_id;
1840                         rx_queue_stats_mappings[nb_rx_queue_stats_mappings].stats_counter_id = map_value;
1841                         nb_rx_queue_stats_mappings++;
1842                 }
1843         }
1844 }
1845
1846 static inline void
1847 print_fdir_mask(struct rte_eth_fdir_masks *mask)
1848 {
1849         printf("\n    vlan_tci: 0x%04x, ", mask->vlan_tci_mask);
1850
1851         if (fdir_conf.mode == RTE_FDIR_MODE_PERFECT_MAC_VLAN)
1852                 printf("mac_addr: 0x%02x", mask->mac_addr_byte_mask);
1853         else if (fdir_conf.mode == RTE_FDIR_MODE_PERFECT_TUNNEL)
1854                 printf("mac_addr: 0x%02x, tunnel_type: 0x%01x, tunnel_id: 0x%08x",
1855                         mask->mac_addr_byte_mask, mask->tunnel_type_mask,
1856                         mask->tunnel_id_mask);
1857         else {
1858                 printf("src_ipv4: 0x%08x, dst_ipv4: 0x%08x,"
1859                         " src_port: 0x%04x, dst_port: 0x%04x",
1860                         mask->ipv4_mask.src_ip, mask->ipv4_mask.dst_ip,
1861                         mask->src_port_mask, mask->dst_port_mask);
1862
1863                 printf("\n    src_ipv6: 0x%08x,0x%08x,0x%08x,0x%08x,"
1864                         " dst_ipv6: 0x%08x,0x%08x,0x%08x,0x%08x",
1865                         mask->ipv6_mask.src_ip[0], mask->ipv6_mask.src_ip[1],
1866                         mask->ipv6_mask.src_ip[2], mask->ipv6_mask.src_ip[3],
1867                         mask->ipv6_mask.dst_ip[0], mask->ipv6_mask.dst_ip[1],
1868                         mask->ipv6_mask.dst_ip[2], mask->ipv6_mask.dst_ip[3]);
1869         }
1870
1871         printf("\n");
1872 }
1873
1874 static inline void
1875 print_fdir_flex_payload(struct rte_eth_fdir_flex_conf *flex_conf, uint32_t num)
1876 {
1877         struct rte_eth_flex_payload_cfg *cfg;
1878         uint32_t i, j;
1879
1880         for (i = 0; i < flex_conf->nb_payloads; i++) {
1881                 cfg = &flex_conf->flex_set[i];
1882                 if (cfg->type == RTE_ETH_RAW_PAYLOAD)
1883                         printf("\n    RAW:  ");
1884                 else if (cfg->type == RTE_ETH_L2_PAYLOAD)
1885                         printf("\n    L2_PAYLOAD:  ");
1886                 else if (cfg->type == RTE_ETH_L3_PAYLOAD)
1887                         printf("\n    L3_PAYLOAD:  ");
1888                 else if (cfg->type == RTE_ETH_L4_PAYLOAD)
1889                         printf("\n    L4_PAYLOAD:  ");
1890                 else
1891                         printf("\n    UNKNOWN PAYLOAD(%u):  ", cfg->type);
1892                 for (j = 0; j < num; j++)
1893                         printf("  %-5u", cfg->src_offset[j]);
1894         }
1895         printf("\n");
1896 }
1897
1898 static char *
1899 flowtype_to_str(uint16_t flow_type)
1900 {
1901         struct flow_type_info {
1902                 char str[32];
1903                 uint16_t ftype;
1904         };
1905
1906         uint8_t i;
1907         static struct flow_type_info flowtype_str_table[] = {
1908                 {"raw", RTE_ETH_FLOW_RAW},
1909                 {"ipv4", RTE_ETH_FLOW_IPV4},
1910                 {"ipv4-frag", RTE_ETH_FLOW_FRAG_IPV4},
1911                 {"ipv4-tcp", RTE_ETH_FLOW_NONFRAG_IPV4_TCP},
1912                 {"ipv4-udp", RTE_ETH_FLOW_NONFRAG_IPV4_UDP},
1913                 {"ipv4-sctp", RTE_ETH_FLOW_NONFRAG_IPV4_SCTP},
1914                 {"ipv4-other", RTE_ETH_FLOW_NONFRAG_IPV4_OTHER},
1915                 {"ipv6", RTE_ETH_FLOW_IPV6},
1916                 {"ipv6-frag", RTE_ETH_FLOW_FRAG_IPV6},
1917                 {"ipv6-tcp", RTE_ETH_FLOW_NONFRAG_IPV6_TCP},
1918                 {"ipv6-udp", RTE_ETH_FLOW_NONFRAG_IPV6_UDP},
1919                 {"ipv6-sctp", RTE_ETH_FLOW_NONFRAG_IPV6_SCTP},
1920                 {"ipv6-other", RTE_ETH_FLOW_NONFRAG_IPV6_OTHER},
1921                 {"l2_payload", RTE_ETH_FLOW_L2_PAYLOAD},
1922         };
1923
1924         for (i = 0; i < RTE_DIM(flowtype_str_table); i++) {
1925                 if (flowtype_str_table[i].ftype == flow_type)
1926                         return flowtype_str_table[i].str;
1927         }
1928
1929         return NULL;
1930 }
1931
1932 static inline void
1933 print_fdir_flex_mask(struct rte_eth_fdir_flex_conf *flex_conf, uint32_t num)
1934 {
1935         struct rte_eth_fdir_flex_mask *mask;
1936         uint32_t i, j;
1937         char *p;
1938
1939         for (i = 0; i < flex_conf->nb_flexmasks; i++) {
1940                 mask = &flex_conf->flex_mask[i];
1941                 p = flowtype_to_str(mask->flow_type);
1942                 printf("\n    %s:\t", p ? p : "unknown");
1943                 for (j = 0; j < num; j++)
1944                         printf(" %02x", mask->mask[j]);
1945         }
1946         printf("\n");
1947 }
1948
1949 static inline void
1950 print_fdir_flow_type(uint32_t flow_types_mask)
1951 {
1952         int i;
1953         char *p;
1954
1955         for (i = RTE_ETH_FLOW_UNKNOWN; i < RTE_ETH_FLOW_MAX; i++) {
1956                 if (!(flow_types_mask & (1 << i)))
1957                         continue;
1958                 p = flowtype_to_str(i);
1959                 if (p)
1960                         printf(" %s", p);
1961                 else
1962                         printf(" unknown");
1963         }
1964         printf("\n");
1965 }
1966
1967 void
1968 fdir_get_infos(portid_t port_id)
1969 {
1970         struct rte_eth_fdir_stats fdir_stat;
1971         struct rte_eth_fdir_info fdir_info;
1972         int ret;
1973
1974         static const char *fdir_stats_border = "########################";
1975
1976         if (port_id_is_invalid(port_id, ENABLED_WARN))
1977                 return;
1978         ret = rte_eth_dev_filter_supported(port_id, RTE_ETH_FILTER_FDIR);
1979         if (ret < 0) {
1980                 printf("\n FDIR is not supported on port %-2d\n",
1981                         port_id);
1982                 return;
1983         }
1984
1985         memset(&fdir_info, 0, sizeof(fdir_info));
1986         rte_eth_dev_filter_ctrl(port_id, RTE_ETH_FILTER_FDIR,
1987                                RTE_ETH_FILTER_INFO, &fdir_info);
1988         memset(&fdir_stat, 0, sizeof(fdir_stat));
1989         rte_eth_dev_filter_ctrl(port_id, RTE_ETH_FILTER_FDIR,
1990                                RTE_ETH_FILTER_STATS, &fdir_stat);
1991         printf("\n  %s FDIR infos for port %-2d     %s\n",
1992                fdir_stats_border, port_id, fdir_stats_border);
1993         printf("  MODE: ");
1994         if (fdir_info.mode == RTE_FDIR_MODE_PERFECT)
1995                 printf("  PERFECT\n");
1996         else if (fdir_info.mode == RTE_FDIR_MODE_PERFECT_MAC_VLAN)
1997                 printf("  PERFECT-MAC-VLAN\n");
1998         else if (fdir_info.mode == RTE_FDIR_MODE_PERFECT_TUNNEL)
1999                 printf("  PERFECT-TUNNEL\n");
2000         else if (fdir_info.mode == RTE_FDIR_MODE_SIGNATURE)
2001                 printf("  SIGNATURE\n");
2002         else
2003                 printf("  DISABLE\n");
2004         if (fdir_info.mode != RTE_FDIR_MODE_PERFECT_MAC_VLAN
2005                 && fdir_info.mode != RTE_FDIR_MODE_PERFECT_TUNNEL) {
2006                 printf("  SUPPORTED FLOW TYPE: ");
2007                 print_fdir_flow_type(fdir_info.flow_types_mask[0]);
2008         }
2009         printf("  FLEX PAYLOAD INFO:\n");
2010         printf("  max_len:       %-10"PRIu32"  payload_limit: %-10"PRIu32"\n"
2011                "  payload_unit:  %-10"PRIu32"  payload_seg:   %-10"PRIu32"\n"
2012                "  bitmask_unit:  %-10"PRIu32"  bitmask_num:   %-10"PRIu32"\n",
2013                 fdir_info.max_flexpayload, fdir_info.flex_payload_limit,
2014                 fdir_info.flex_payload_unit,
2015                 fdir_info.max_flex_payload_segment_num,
2016                 fdir_info.flex_bitmask_unit, fdir_info.max_flex_bitmask_num);
2017         printf("  MASK: ");
2018         print_fdir_mask(&fdir_info.mask);
2019         if (fdir_info.flex_conf.nb_payloads > 0) {
2020                 printf("  FLEX PAYLOAD SRC OFFSET:");
2021                 print_fdir_flex_payload(&fdir_info.flex_conf, fdir_info.max_flexpayload);
2022         }
2023         if (fdir_info.flex_conf.nb_flexmasks > 0) {
2024                 printf("  FLEX MASK CFG:");
2025                 print_fdir_flex_mask(&fdir_info.flex_conf, fdir_info.max_flexpayload);
2026         }
2027         printf("  guarant_count: %-10"PRIu32"  best_count:    %"PRIu32"\n",
2028                fdir_stat.guarant_cnt, fdir_stat.best_cnt);
2029         printf("  guarant_space: %-10"PRIu32"  best_space:    %"PRIu32"\n",
2030                fdir_info.guarant_spc, fdir_info.best_spc);
2031         printf("  collision:     %-10"PRIu32"  free:          %"PRIu32"\n"
2032                "  maxhash:       %-10"PRIu32"  maxlen:        %"PRIu32"\n"
2033                "  add:           %-10"PRIu64"  remove:        %"PRIu64"\n"
2034                "  f_add:         %-10"PRIu64"  f_remove:      %"PRIu64"\n",
2035                fdir_stat.collision, fdir_stat.free,
2036                fdir_stat.maxhash, fdir_stat.maxlen,
2037                fdir_stat.add, fdir_stat.remove,
2038                fdir_stat.f_add, fdir_stat.f_remove);
2039         printf("  %s############################%s\n",
2040                fdir_stats_border, fdir_stats_border);
2041 }
2042
2043 void
2044 fdir_set_flex_mask(portid_t port_id, struct rte_eth_fdir_flex_mask *cfg)
2045 {
2046         struct rte_port *port;
2047         struct rte_eth_fdir_flex_conf *flex_conf;
2048         int i, idx = 0;
2049
2050         port = &ports[port_id];
2051         flex_conf = &port->dev_conf.fdir_conf.flex_conf;
2052         for (i = 0; i < RTE_ETH_FLOW_MAX; i++) {
2053                 if (cfg->flow_type == flex_conf->flex_mask[i].flow_type) {
2054                         idx = i;
2055                         break;
2056                 }
2057         }
2058         if (i >= RTE_ETH_FLOW_MAX) {
2059                 if (flex_conf->nb_flexmasks < RTE_DIM(flex_conf->flex_mask)) {
2060                         idx = flex_conf->nb_flexmasks;
2061                         flex_conf->nb_flexmasks++;
2062                 } else {
2063                         printf("The flex mask table is full. Can not set flex"
2064                                 " mask for flow_type(%u).", cfg->flow_type);
2065                         return;
2066                 }
2067         }
2068         (void)rte_memcpy(&flex_conf->flex_mask[idx],
2069                          cfg,
2070                          sizeof(struct rte_eth_fdir_flex_mask));
2071 }
2072
2073 void
2074 fdir_set_flex_payload(portid_t port_id, struct rte_eth_flex_payload_cfg *cfg)
2075 {
2076         struct rte_port *port;
2077         struct rte_eth_fdir_flex_conf *flex_conf;
2078         int i, idx = 0;
2079
2080         port = &ports[port_id];
2081         flex_conf = &port->dev_conf.fdir_conf.flex_conf;
2082         for (i = 0; i < RTE_ETH_PAYLOAD_MAX; i++) {
2083                 if (cfg->type == flex_conf->flex_set[i].type) {
2084                         idx = i;
2085                         break;
2086                 }
2087         }
2088         if (i >= RTE_ETH_PAYLOAD_MAX) {
2089                 if (flex_conf->nb_payloads < RTE_DIM(flex_conf->flex_set)) {
2090                         idx = flex_conf->nb_payloads;
2091                         flex_conf->nb_payloads++;
2092                 } else {
2093                         printf("The flex payload table is full. Can not set"
2094                                 " flex payload for type(%u).", cfg->type);
2095                         return;
2096                 }
2097         }
2098         (void)rte_memcpy(&flex_conf->flex_set[idx],
2099                          cfg,
2100                          sizeof(struct rte_eth_flex_payload_cfg));
2101
2102 }
2103
2104 void
2105 set_vf_traffic(portid_t port_id, uint8_t is_rx, uint16_t vf, uint8_t on)
2106 {
2107         int diag;
2108
2109         if (port_id_is_invalid(port_id, ENABLED_WARN))
2110                 return;
2111         if (is_rx)
2112                 diag = rte_eth_dev_set_vf_rx(port_id,vf,on);
2113         else
2114                 diag = rte_eth_dev_set_vf_tx(port_id,vf,on);
2115         if (diag == 0)
2116                 return;
2117         if(is_rx)
2118                 printf("rte_eth_dev_set_vf_rx for port_id=%d failed "
2119                         "diag=%d\n", port_id, diag);
2120         else
2121                 printf("rte_eth_dev_set_vf_tx for port_id=%d failed "
2122                         "diag=%d\n", port_id, diag);
2123
2124 }
2125
2126 void
2127 set_vf_rx_vlan(portid_t port_id, uint16_t vlan_id, uint64_t vf_mask, uint8_t on)
2128 {
2129         int diag;
2130
2131         if (port_id_is_invalid(port_id, ENABLED_WARN))
2132                 return;
2133         if (vlan_id_is_invalid(vlan_id))
2134                 return;
2135         diag = rte_eth_dev_set_vf_vlan_filter(port_id, vlan_id, vf_mask, on);
2136         if (diag == 0)
2137                 return;
2138         printf("rte_eth_dev_set_vf_vlan_filter for port_id=%d failed "
2139                "diag=%d\n", port_id, diag);
2140 }
2141
2142 int
2143 set_queue_rate_limit(portid_t port_id, uint16_t queue_idx, uint16_t rate)
2144 {
2145         int diag;
2146         struct rte_eth_link link;
2147
2148         if (port_id_is_invalid(port_id, ENABLED_WARN))
2149                 return 1;
2150         rte_eth_link_get_nowait(port_id, &link);
2151         if (rate > link.link_speed) {
2152                 printf("Invalid rate value:%u bigger than link speed: %u\n",
2153                         rate, link.link_speed);
2154                 return 1;
2155         }
2156         diag = rte_eth_set_queue_rate_limit(port_id, queue_idx, rate);
2157         if (diag == 0)
2158                 return diag;
2159         printf("rte_eth_set_queue_rate_limit for port_id=%d failed diag=%d\n",
2160                 port_id, diag);
2161         return diag;
2162 }
2163
2164 int
2165 set_vf_rate_limit(portid_t port_id, uint16_t vf, uint16_t rate, uint64_t q_msk)
2166 {
2167         int diag;
2168         struct rte_eth_link link;
2169
2170         if (q_msk == 0)
2171                 return 0;
2172
2173         if (port_id_is_invalid(port_id, ENABLED_WARN))
2174                 return 1;
2175         rte_eth_link_get_nowait(port_id, &link);
2176         if (rate > link.link_speed) {
2177                 printf("Invalid rate value:%u bigger than link speed: %u\n",
2178                         rate, link.link_speed);
2179                 return 1;
2180         }
2181         diag = rte_eth_set_vf_rate_limit(port_id, vf, rate, q_msk);
2182         if (diag == 0)
2183                 return diag;
2184         printf("rte_eth_set_vf_rate_limit for port_id=%d failed diag=%d\n",
2185                 port_id, diag);
2186         return diag;
2187 }
2188
2189 /*
2190  * Functions to manage the set of filtered Multicast MAC addresses.
2191  *
2192  * A pool of filtered multicast MAC addresses is associated with each port.
2193  * The pool is allocated in chunks of MCAST_POOL_INC multicast addresses.
2194  * The address of the pool and the number of valid multicast MAC addresses
2195  * recorded in the pool are stored in the fields "mc_addr_pool" and
2196  * "mc_addr_nb" of the "rte_port" data structure.
2197  *
2198  * The function "rte_eth_dev_set_mc_addr_list" of the PMDs API imposes
2199  * to be supplied a contiguous array of multicast MAC addresses.
2200  * To comply with this constraint, the set of multicast addresses recorded
2201  * into the pool are systematically compacted at the beginning of the pool.
2202  * Hence, when a multicast address is removed from the pool, all following
2203  * addresses, if any, are copied back to keep the set contiguous.
2204  */
2205 #define MCAST_POOL_INC 32
2206
2207 static int
2208 mcast_addr_pool_extend(struct rte_port *port)
2209 {
2210         struct ether_addr *mc_pool;
2211         size_t mc_pool_size;
2212
2213         /*
2214          * If a free entry is available at the end of the pool, just
2215          * increment the number of recorded multicast addresses.
2216          */
2217         if ((port->mc_addr_nb % MCAST_POOL_INC) != 0) {
2218                 port->mc_addr_nb++;
2219                 return 0;
2220         }
2221
2222         /*
2223          * [re]allocate a pool with MCAST_POOL_INC more entries.
2224          * The previous test guarantees that port->mc_addr_nb is a multiple
2225          * of MCAST_POOL_INC.
2226          */
2227         mc_pool_size = sizeof(struct ether_addr) * (port->mc_addr_nb +
2228                                                     MCAST_POOL_INC);
2229         mc_pool = (struct ether_addr *) realloc(port->mc_addr_pool,
2230                                                 mc_pool_size);
2231         if (mc_pool == NULL) {
2232                 printf("allocation of pool of %u multicast addresses failed\n",
2233                        port->mc_addr_nb + MCAST_POOL_INC);
2234                 return -ENOMEM;
2235         }
2236
2237         port->mc_addr_pool = mc_pool;
2238         port->mc_addr_nb++;
2239         return 0;
2240
2241 }
2242
2243 static void
2244 mcast_addr_pool_remove(struct rte_port *port, uint32_t addr_idx)
2245 {
2246         port->mc_addr_nb--;
2247         if (addr_idx == port->mc_addr_nb) {
2248                 /* No need to recompact the set of multicast addressses. */
2249                 if (port->mc_addr_nb == 0) {
2250                         /* free the pool of multicast addresses. */
2251                         free(port->mc_addr_pool);
2252                         port->mc_addr_pool = NULL;
2253                 }
2254                 return;
2255         }
2256         memmove(&port->mc_addr_pool[addr_idx],
2257                 &port->mc_addr_pool[addr_idx + 1],
2258                 sizeof(struct ether_addr) * (port->mc_addr_nb - addr_idx));
2259 }
2260
2261 static void
2262 eth_port_multicast_addr_list_set(uint8_t port_id)
2263 {
2264         struct rte_port *port;
2265         int diag;
2266
2267         port = &ports[port_id];
2268         diag = rte_eth_dev_set_mc_addr_list(port_id, port->mc_addr_pool,
2269                                             port->mc_addr_nb);
2270         if (diag == 0)
2271                 return;
2272         printf("rte_eth_dev_set_mc_addr_list(port=%d, nb=%u) failed. diag=%d\n",
2273                port->mc_addr_nb, port_id, -diag);
2274 }
2275
2276 void
2277 mcast_addr_add(uint8_t port_id, struct ether_addr *mc_addr)
2278 {
2279         struct rte_port *port;
2280         uint32_t i;
2281
2282         if (port_id_is_invalid(port_id, ENABLED_WARN))
2283                 return;
2284
2285         port = &ports[port_id];
2286
2287         /*
2288          * Check that the added multicast MAC address is not already recorded
2289          * in the pool of multicast addresses.
2290          */
2291         for (i = 0; i < port->mc_addr_nb; i++) {
2292                 if (is_same_ether_addr(mc_addr, &port->mc_addr_pool[i])) {
2293                         printf("multicast address already filtered by port\n");
2294                         return;
2295                 }
2296         }
2297
2298         if (mcast_addr_pool_extend(port) != 0)
2299                 return;
2300         ether_addr_copy(mc_addr, &port->mc_addr_pool[i]);
2301         eth_port_multicast_addr_list_set(port_id);
2302 }
2303
2304 void
2305 mcast_addr_remove(uint8_t port_id, struct ether_addr *mc_addr)
2306 {
2307         struct rte_port *port;
2308         uint32_t i;
2309
2310         if (port_id_is_invalid(port_id, ENABLED_WARN))
2311                 return;
2312
2313         port = &ports[port_id];
2314
2315         /*
2316          * Search the pool of multicast MAC addresses for the removed address.
2317          */
2318         for (i = 0; i < port->mc_addr_nb; i++) {
2319                 if (is_same_ether_addr(mc_addr, &port->mc_addr_pool[i]))
2320                         break;
2321         }
2322         if (i == port->mc_addr_nb) {
2323                 printf("multicast address not filtered by port %d\n", port_id);
2324                 return;
2325         }
2326
2327         mcast_addr_pool_remove(port, i);
2328         eth_port_multicast_addr_list_set(port_id);
2329 }