examples/l3fwd-graph/main.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(C) 2020 Marvell International Ltd.
   3  */
   4
   5 #include <arpa/inet.h>
   6 #include <errno.h>
   7 #include <getopt.h>
   8 #include <inttypes.h>
   9 #include <signal.h>
  10 #include <stdarg.h>
  11 #include <stdbool.h>
  12 #include <stdint.h>
  13 #include <stdio.h>
  14 #include <stdlib.h>
  15 #include <string.h>
  16 #include <sys/socket.h>
  17 #include <sys/types.h>
  18 #include <sys/queue.h>
  19 #include <unistd.h>
  20
  21 #include <rte_branch_prediction.h>
  22 #include <rte_common.h>
  23 #include <rte_cycles.h>
  24 #include <rte_eal.h>
  25 #include <rte_ethdev.h>
  26 #include <rte_graph_worker.h>
  27 #include <rte_launch.h>
  28 #include <rte_lcore.h>
  29 #include <rte_log.h>
  30 #include <rte_mempool.h>
  31 #include <rte_node_eth_api.h>
  32 #include <rte_node_ip4_api.h>
  33 #include <rte_per_lcore.h>
  34 #include <rte_string_fns.h>
  35 #include <rte_vect.h>
  36
  37 #include <cmdline_parse.h>
  38 #include <cmdline_parse_etheraddr.h>
  39
  40 /* Log type */
  41 #define RTE_LOGTYPE_L3FWD_GRAPH RTE_LOGTYPE_USER1
  42
  43 /*
  44  * Configurable number of RX/TX ring descriptors
  45  */
  46 #define RTE_TEST_RX_DESC_DEFAULT 1024
  47 #define RTE_TEST_TX_DESC_DEFAULT 1024
  48
  49 #define MAX_TX_QUEUE_PER_PORT RTE_MAX_ETHPORTS
  50 #define MAX_RX_QUEUE_PER_PORT 128
  51
  52 #define MAX_RX_QUEUE_PER_LCORE 16
  53
  54 #define MAX_LCORE_PARAMS 1024
  55
  56 #define NB_SOCKETS 8
  57
  58 /* Static global variables used within this file. */
  59 static uint16_t nb_rxd = RTE_TEST_RX_DESC_DEFAULT;
  60 static uint16_t nb_txd = RTE_TEST_TX_DESC_DEFAULT;
  61
  62 /**< Ports set in promiscuous mode off by default. */
  63 static int promiscuous_on;
  64
  65 static int numa_on = 1;   /**< NUMA is enabled by default. */
  66 static int per_port_pool; /**< Use separate buffer pools per port; disabled */
  67                           /**< by default */
  68
  69 static volatile bool force_quit;
  70
  71 /* Ethernet addresses of ports */
  72 static uint64_t dest_eth_addr[RTE_MAX_ETHPORTS];
  73 static struct rte_ether_addr ports_eth_addr[RTE_MAX_ETHPORTS];
  74 xmm_t val_eth[RTE_MAX_ETHPORTS];
  75
  76 /* Mask of enabled ports */
  77 static uint32_t enabled_port_mask;
  78
  79 struct lcore_rx_queue {
  80         uint16_t port_id;
  81         uint8_t queue_id;
  82         char node_name[RTE_NODE_NAMESIZE];
  83 };
  84
  85 /* Lcore conf */
  86 struct lcore_conf {
  87         uint16_t n_rx_queue;
  88         struct lcore_rx_queue rx_queue_list[MAX_RX_QUEUE_PER_LCORE];
  89
  90         struct rte_graph *graph;
  91         char name[RTE_GRAPH_NAMESIZE];
  92         rte_graph_t graph_id;
  93 } __rte_cache_aligned;
  94
  95 static struct lcore_conf lcore_conf[RTE_MAX_LCORE];
  96
  97 struct lcore_params {
  98         uint16_t port_id;
  99         uint8_t queue_id;
 100         uint8_t lcore_id;
 101 } __rte_cache_aligned;
 102
 103 static struct lcore_params lcore_params_array[MAX_LCORE_PARAMS];
 104 static struct lcore_params lcore_params_array_default[] = {
 105         {0, 0, 2}, {0, 1, 2}, {0, 2, 2}, {1, 0, 2}, {1, 1, 2},
 106         {1, 2, 2}, {2, 0, 2}, {3, 0, 3}, {3, 1, 3},
 107 };
 108
 109 static struct lcore_params *lcore_params = lcore_params_array_default;
 110 static uint16_t nb_lcore_params = RTE_DIM(lcore_params_array_default);
 111
 112 static struct rte_eth_conf port_conf = {
 113         .rxmode = {
 114                 .mq_mode = ETH_MQ_RX_RSS,
 115                 .max_rx_pkt_len = RTE_ETHER_MAX_LEN,
 116                 .split_hdr_size = 0,
 117         },
 118         .rx_adv_conf = {
 119                 .rss_conf = {
 120                                 .rss_key = NULL,
 121                                 .rss_hf = ETH_RSS_IP,
 122                 },
 123         },
 124         .txmode = {
 125                 .mq_mode = ETH_MQ_TX_NONE,
 126         },
 127 };
 128
 129 static struct rte_mempool *pktmbuf_pool[RTE_MAX_ETHPORTS][NB_SOCKETS];
 130
 131 static struct rte_node_ethdev_config ethdev_conf[RTE_MAX_ETHPORTS];
 132
 133 struct ipv4_l3fwd_lpm_route {
 134         uint32_t ip;
 135         uint8_t depth;
 136         uint8_t if_out;
 137 };
 138
 139 #define IPV4_L3FWD_LPM_NUM_ROUTES                                              \
 140         (sizeof(ipv4_l3fwd_lpm_route_array) /                                  \
 141          sizeof(ipv4_l3fwd_lpm_route_array[0]))
 142 /* 198.18.0.0/16 are set aside for RFC2544 benchmarking. */
 143 static struct ipv4_l3fwd_lpm_route ipv4_l3fwd_lpm_route_array[] = {
 144         {RTE_IPV4(198, 18, 0, 0), 24, 0}, {RTE_IPV4(198, 18, 1, 0), 24, 1},
 145         {RTE_IPV4(198, 18, 2, 0), 24, 2}, {RTE_IPV4(198, 18, 3, 0), 24, 3},
 146         {RTE_IPV4(198, 18, 4, 0), 24, 4}, {RTE_IPV4(198, 18, 5, 0), 24, 5},
 147         {RTE_IPV4(198, 18, 6, 0), 24, 6}, {RTE_IPV4(198, 18, 7, 0), 24, 7},
 148 };
 149
 150 static int
 151 check_lcore_params(void)
 152 {
 153         uint8_t queue, lcore;
 154         int socketid;
 155         uint16_t i;
 156
 157         for (i = 0; i < nb_lcore_params; ++i) {
 158                 queue = lcore_params[i].queue_id;
 159                 if (queue >= MAX_RX_QUEUE_PER_PORT) {
 160                         printf("Invalid queue number: %hhu\n", queue);
 161                         return -1;
 162                 }
 163                 lcore = lcore_params[i].lcore_id;
 164                 if (!rte_lcore_is_enabled(lcore)) {
 165                         printf("Error: lcore %hhu is not enabled in lcore mask\n",
 166                                lcore);
 167                         return -1;
 168                 }
 169
 170                 if (lcore == rte_get_master_lcore()) {
 171                         printf("Error: lcore %u is master lcore\n", lcore);
 172                         return -1;
 173                 }
 174                 socketid = rte_lcore_to_socket_id(lcore);
 175                 if ((socketid != 0) && (numa_on == 0)) {
 176                         printf("Warning: lcore %hhu is on socket %d with numa off\n",
 177                                lcore, socketid);
 178                 }
 179         }
 180
 181         return 0;
 182 }
 183
 184 static int
 185 check_port_config(void)
 186 {
 187         uint16_t portid;
 188         uint16_t i;
 189
 190         for (i = 0; i < nb_lcore_params; ++i) {
 191                 portid = lcore_params[i].port_id;
 192                 if ((enabled_port_mask & (1 << portid)) == 0) {
 193                         printf("Port %u is not enabled in port mask\n", portid);
 194                         return -1;
 195                 }
 196                 if (!rte_eth_dev_is_valid_port(portid)) {
 197                         printf("Port %u is not present on the board\n", portid);
 198                         return -1;
 199                 }
 200         }
 201
 202         return 0;
 203 }
 204
 205 static uint8_t
 206 get_port_n_rx_queues(const uint16_t port)
 207 {
 208         int queue = -1;
 209         uint16_t i;
 210
 211         for (i = 0; i < nb_lcore_params; ++i) {
 212                 if (lcore_params[i].port_id == port) {
 213                         if (lcore_params[i].queue_id == queue + 1)
 214                                 queue = lcore_params[i].queue_id;
 215                         else
 216                                 rte_exit(EXIT_FAILURE,
 217                                          "Queue ids of the port %d must be"
 218                                          " in sequence and must start with 0\n",
 219                                          lcore_params[i].port_id);
 220                 }
 221         }
 222
 223         return (uint8_t)(++queue);
 224 }
 225
 226 static int
 227 init_lcore_rx_queues(void)
 228 {
 229         uint16_t i, nb_rx_queue;
 230         uint8_t lcore;
 231
 232         for (i = 0; i < nb_lcore_params; ++i) {
 233                 lcore = lcore_params[i].lcore_id;
 234                 nb_rx_queue = lcore_conf[lcore].n_rx_queue;
 235                 if (nb_rx_queue >= MAX_RX_QUEUE_PER_LCORE) {
 236                         printf("Error: too many queues (%u) for lcore: %u\n",
 237                                (unsigned int)nb_rx_queue + 1,
 238                                (unsigned int)lcore);
 239                         return -1;
 240                 }
 241
 242                 lcore_conf[lcore].rx_queue_list[nb_rx_queue].port_id =
 243                         lcore_params[i].port_id;
 244                 lcore_conf[lcore].rx_queue_list[nb_rx_queue].queue_id =
 245                         lcore_params[i].queue_id;
 246                 lcore_conf[lcore].n_rx_queue++;
 247         }
 248
 249         return 0;
 250 }
 251
 252 /* Display usage */
 253 static void
 254 print_usage(const char *prgname)
 255 {
 256         fprintf(stderr,
 257                 "%s [EAL options] --"
 258                 " -p PORTMASK"
 259                 " [-P]"
 260                 " --config (port,queue,lcore)[,(port,queue,lcore)]"
 261                 " [--eth-dest=X,MM:MM:MM:MM:MM:MM]"
 262                 " [--enable-jumbo [--max-pkt-len PKTLEN]]"
 263                 " [--no-numa]"
 264                 " [--per-port-pool]\n\n"
 265
 266                 "  -p PORTMASK: Hexadecimal bitmask of ports to configure\n"
 267                 "  -P : Enable promiscuous mode\n"
 268                 "  --config (port,queue,lcore): Rx queue configuration\n"
 269                 "  --eth-dest=X,MM:MM:MM:MM:MM:MM: Ethernet destination for "
 270                 "port X\n"
 271                 "  --enable-jumbo: Enable jumbo frames\n"
 272                 "  --max-pkt-len: Under the premise of enabling jumbo,\n"
 273                 "                 maximum packet length in decimal (64-9600)\n"
 274                 "  --no-numa: Disable numa awareness\n"
 275                 "  --per-port-pool: Use separate buffer pool per port\n\n",
 276                 prgname);
 277 }
 278
 279 static int
 280 parse_max_pkt_len(const char *pktlen)
 281 {
 282         unsigned long len;
 283         char *end = NULL;
 284
 285         /* Parse decimal string */
 286         len = strtoul(pktlen, &end, 10);
 287         if ((pktlen[0] == '\0') || (end == NULL) || (*end != '\0'))
 288                 return -1;
 289
 290         if (len == 0)
 291                 return -1;
 292
 293         return len;
 294 }
 295
 296 static int
 297 parse_portmask(const char *portmask)
 298 {
 299         char *end = NULL;
 300         unsigned long pm;
 301
 302         /* Parse hexadecimal string */
 303         pm = strtoul(portmask, &end, 16);
 304         if ((portmask[0] == '\0') || (end == NULL) || (*end != '\0'))
 305                 return 0;
 306
 307         return pm;
 308 }
 309
 310 static int
 311 parse_config(const char *q_arg)
 312 {
 313         enum fieldnames { FLD_PORT = 0, FLD_QUEUE, FLD_LCORE, _NUM_FLD };
 314         unsigned long int_fld[_NUM_FLD];
 315         const char *p, *p0 = q_arg;
 316         char *str_fld[_NUM_FLD];
 317         uint32_t size;
 318         char s[256];
 319         char *end;
 320         int i;
 321
 322         nb_lcore_params = 0;
 323
 324         while ((p = strchr(p0, '(')) != NULL) {
 325                 ++p;
 326                 p0 = strchr(p, ')');
 327                 if (p0 == NULL)
 328                         return -1;
 329
 330                 size = p0 - p;
 331                 if (size >= sizeof(s))
 332                         return -1;
 333
 334                 memcpy(s, p, size);
 335                 s[size] = '\0';
 336                 if (rte_strsplit(s, sizeof(s), str_fld, _NUM_FLD, ',') !=
 337                     _NUM_FLD)
 338                         return -1;
 339                 for (i = 0; i < _NUM_FLD; i++) {
 340                         errno = 0;
 341                         int_fld[i] = strtoul(str_fld[i], &end, 0);
 342                         if (errno != 0 || end == str_fld[i])
 343                                 return -1;
 344                 }
 345
 346                 if (nb_lcore_params >= MAX_LCORE_PARAMS) {
 347                         printf("Exceeded max number of lcore params: %hu\n",
 348                                nb_lcore_params);
 349                         return -1;
 350                 }
 351
 352                 if (int_fld[FLD_PORT] >= RTE_MAX_ETHPORTS ||
 353                     int_fld[FLD_LCORE] >= RTE_MAX_LCORE) {
 354                         printf("Invalid port/lcore id\n");
 355                         return -1;
 356                 }
 357
 358                 lcore_params_array[nb_lcore_params].port_id =
 359                         (uint8_t)int_fld[FLD_PORT];
 360                 lcore_params_array[nb_lcore_params].queue_id =
 361                         (uint8_t)int_fld[FLD_QUEUE];
 362                 lcore_params_array[nb_lcore_params].lcore_id =
 363                         (uint8_t)int_fld[FLD_LCORE];
 364                 ++nb_lcore_params;
 365         }
 366         lcore_params = lcore_params_array;
 367
 368         return 0;
 369 }
 370
 371 static void
 372 parse_eth_dest(const char *optarg)
 373 {
 374         uint8_t c, *dest, peer_addr[6];
 375         uint16_t portid;
 376         char *port_end;
 377
 378         errno = 0;
 379         portid = strtoul(optarg, &port_end, 10);
 380         if (errno != 0 || port_end == optarg || *port_end++ != ',')
 381                 rte_exit(EXIT_FAILURE, "Invalid eth-dest: %s", optarg);
 382         if (portid >= RTE_MAX_ETHPORTS)
 383                 rte_exit(EXIT_FAILURE,
 384                          "eth-dest: port %d >= RTE_MAX_ETHPORTS(%d)\n", portid,
 385                          RTE_MAX_ETHPORTS);
 386
 387         if (cmdline_parse_etheraddr(NULL, port_end, &peer_addr,
 388                                     sizeof(peer_addr)) < 0)
 389                 rte_exit(EXIT_FAILURE, "Invalid ethernet address: %s\n",
 390                          port_end);
 391         dest = (uint8_t *)&dest_eth_addr[portid];
 392         for (c = 0; c < 6; c++)
 393                 dest[c] = peer_addr[c];
 394         *(uint64_t *)(val_eth + portid) = dest_eth_addr[portid];
 395 }
 396
 397 #define MAX_JUMBO_PKT_LEN  9600
 398 #define MEMPOOL_CACHE_SIZE 256
 399
 400 static const char short_options[] = "p:" /* portmask */
 401                                     "P"  /* promiscuous */
 402         ;
 403
 404 #define CMD_LINE_OPT_CONFIG        "config"
 405 #define CMD_LINE_OPT_ETH_DEST      "eth-dest"
 406 #define CMD_LINE_OPT_NO_NUMA       "no-numa"
 407 #define CMD_LINE_OPT_ENABLE_JUMBO  "enable-jumbo"
 408 #define CMD_LINE_OPT_PER_PORT_POOL "per-port-pool"
 409 enum {
 410         /* Long options mapped to a short option */
 411
 412         /* First long only option value must be >= 256, so that we won't
 413          * conflict with short options
 414          */
 415         CMD_LINE_OPT_MIN_NUM = 256,
 416         CMD_LINE_OPT_CONFIG_NUM,
 417         CMD_LINE_OPT_ETH_DEST_NUM,
 418         CMD_LINE_OPT_NO_NUMA_NUM,
 419         CMD_LINE_OPT_ENABLE_JUMBO_NUM,
 420         CMD_LINE_OPT_PARSE_PER_PORT_POOL,
 421 };
 422
 423 static const struct option lgopts[] = {
 424         {CMD_LINE_OPT_CONFIG, 1, 0, CMD_LINE_OPT_CONFIG_NUM},
 425         {CMD_LINE_OPT_ETH_DEST, 1, 0, CMD_LINE_OPT_ETH_DEST_NUM},
 426         {CMD_LINE_OPT_NO_NUMA, 0, 0, CMD_LINE_OPT_NO_NUMA_NUM},
 427         {CMD_LINE_OPT_ENABLE_JUMBO, 0, 0, CMD_LINE_OPT_ENABLE_JUMBO_NUM},
 428         {CMD_LINE_OPT_PER_PORT_POOL, 0, 0, CMD_LINE_OPT_PARSE_PER_PORT_POOL},
 429         {NULL, 0, 0, 0},
 430 };
 431
 432 /*
 433  * This expression is used to calculate the number of mbufs needed
 434  * depending on user input, taking  into account memory for rx and
 435  * tx hardware rings, cache per lcore and mtable per port per lcore.
 436  * RTE_MAX is used to ensure that NB_MBUF never goes below a minimum
 437  * value of 8192
 438  */
 439 #define NB_MBUF(nports)                                                        \
 440         RTE_MAX((nports * nb_rx_queue * nb_rxd +                               \
 441                  nports * nb_lcores * RTE_GRAPH_BURST_SIZE +                   \
 442                  nports * n_tx_queue * nb_txd +                                \
 443                  nb_lcores * MEMPOOL_CACHE_SIZE), 8192u)
 444
 445 /* Parse the argument given in the command line of the application */
 446 static int
 447 parse_args(int argc, char **argv)
 448 {
 449         char *prgname = argv[0];
 450         int option_index;
 451         char **argvopt;
 452         int opt, ret;
 453
 454         argvopt = argv;
 455
 456         /* Error or normal output strings. */
 457         while ((opt = getopt_long(argc, argvopt, short_options, lgopts,
 458                                   &option_index)) != EOF) {
 459
 460                 switch (opt) {
 461                 /* Portmask */
 462                 case 'p':
 463                         enabled_port_mask = parse_portmask(optarg);
 464                         if (enabled_port_mask == 0) {
 465                                 fprintf(stderr, "Invalid portmask\n");
 466                                 print_usage(prgname);
 467                                 return -1;
 468                         }
 469                         break;
 470
 471                 case 'P':
 472                         promiscuous_on = 1;
 473                         break;
 474
 475                 /* Long options */
 476                 case CMD_LINE_OPT_CONFIG_NUM:
 477                         ret = parse_config(optarg);
 478                         if (ret) {
 479                                 fprintf(stderr, "Invalid config\n");
 480                                 print_usage(prgname);
 481                                 return -1;
 482                         }
 483                         break;
 484
 485                 case CMD_LINE_OPT_ETH_DEST_NUM:
 486                         parse_eth_dest(optarg);
 487                         break;
 488
 489                 case CMD_LINE_OPT_NO_NUMA_NUM:
 490                         numa_on = 0;
 491                         break;
 492
 493                 case CMD_LINE_OPT_ENABLE_JUMBO_NUM: {
 494                         const struct option lenopts = {"max-pkt-len",
 495                                                        required_argument, 0, 0};
 496
 497                         port_conf.rxmode.offloads |= DEV_RX_OFFLOAD_JUMBO_FRAME;
 498                         port_conf.txmode.offloads |= DEV_TX_OFFLOAD_MULTI_SEGS;
 499
 500                         /*
 501                          * if no max-pkt-len set, use the default
 502                          * value RTE_ETHER_MAX_LEN.
 503                          */
 504                         if (getopt_long(argc, argvopt, "", &lenopts,
 505                                         &option_index) == 0) {
 506                                 ret = parse_max_pkt_len(optarg);
 507                                 if (ret < 64 || ret > MAX_JUMBO_PKT_LEN) {
 508                                         fprintf(stderr, "Invalid maximum "
 509                                                         "packet length\n");
 510                                         print_usage(prgname);
 511                                         return -1;
 512                                 }
 513                                 port_conf.rxmode.max_rx_pkt_len = ret;
 514                         }
 515                         break;
 516                 }
 517
 518                 case CMD_LINE_OPT_PARSE_PER_PORT_POOL:
 519                         printf("Per port buffer pool is enabled\n");
 520                         per_port_pool = 1;
 521                         break;
 522
 523                 default:
 524                         print_usage(prgname);
 525                         return -1;
 526                 }
 527         }
 528
 529         if (optind >= 0)
 530                 argv[optind - 1] = prgname;
 531         ret = optind - 1;
 532         optind = 1; /* Reset getopt lib */
 533
 534         return ret;
 535 }
 536
 537 static void
 538 print_ethaddr(const char *name, const struct rte_ether_addr *eth_addr)
 539 {
 540         char buf[RTE_ETHER_ADDR_FMT_SIZE];
 541         rte_ether_format_addr(buf, RTE_ETHER_ADDR_FMT_SIZE, eth_addr);
 542         printf("%s%s", name, buf);
 543 }
 544
 545 static int
 546 init_mem(uint16_t portid, uint32_t nb_mbuf)
 547 {
 548         uint32_t lcore_id;
 549         int socketid;
 550         char s[64];
 551
 552         for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++) {
 553                 if (rte_lcore_is_enabled(lcore_id) == 0)
 554                         continue;
 555
 556                 if (numa_on)
 557                         socketid = rte_lcore_to_socket_id(lcore_id);
 558                 else
 559                         socketid = 0;
 560
 561                 if (socketid >= NB_SOCKETS) {
 562                         rte_exit(EXIT_FAILURE,
 563                                  "Socket %d of lcore %u is out of range %d\n",
 564                                  socketid, lcore_id, NB_SOCKETS);
 565                 }
 566
 567                 if (pktmbuf_pool[portid][socketid] == NULL) {
 568                         snprintf(s, sizeof(s), "mbuf_pool_%d:%d", portid,
 569                                  socketid);
 570                         /* Create a pool with priv size of a cacheline */
 571                         pktmbuf_pool[portid][socketid] =
 572                                 rte_pktmbuf_pool_create(
 573                                         s, nb_mbuf, MEMPOOL_CACHE_SIZE,
 574                                         RTE_CACHE_LINE_SIZE,
 575                                         RTE_MBUF_DEFAULT_BUF_SIZE, socketid);
 576                         if (pktmbuf_pool[portid][socketid] == NULL)
 577                                 rte_exit(EXIT_FAILURE,
 578                                          "Cannot init mbuf pool on socket %d\n",
 579                                          socketid);
 580                         else
 581                                 printf("Allocated mbuf pool on socket %d\n",
 582                                        socketid);
 583                 }
 584         }
 585
 586         return 0;
 587 }
 588
 589 /* Check the link status of all ports in up to 9s, and print them finally */
 590 static void
 591 check_all_ports_link_status(uint32_t port_mask)
 592 {
 593 #define CHECK_INTERVAL 100 /* 100ms */
 594 #define MAX_CHECK_TIME 90  /* 9s (90 * 100ms) in total */
 595         uint8_t count, all_ports_up, print_flag = 0;
 596         struct rte_eth_link link;
 597         uint16_t portid;
 598         int ret;
 599
 600         printf("\nChecking link status");
 601         fflush(stdout);
 602         for (count = 0; count <= MAX_CHECK_TIME; count++) {
 603                 if (force_quit)
 604                         return;
 605                 all_ports_up = 1;
 606                 RTE_ETH_FOREACH_DEV(portid)
 607                 {
 608                         if (force_quit)
 609                                 return;
 610                         if ((port_mask & (1 << portid)) == 0)
 611                                 continue;
 612                         memset(&link, 0, sizeof(link));
 613                         ret = rte_eth_link_get_nowait(portid, &link);
 614                         if (ret < 0) {
 615                                 all_ports_up = 0;
 616                                 if (print_flag == 1)
 617                                         printf("Port %u link get failed: %s\n",
 618                                                 portid, rte_strerror(-ret));
 619                                 continue;
 620                         }
 621                         /* Print link status if flag set */
 622                         if (print_flag == 1) {
 623                                 if (link.link_status)
 624                                         printf("Port%d Link Up. Speed %u Mbps "
 625                                                "-%s\n",
 626                                                portid, link.link_speed,
 627                                                (link.link_duplex ==
 628                                                 ETH_LINK_FULL_DUPLEX)
 629                                                        ? ("full-duplex")
 630                                                        : ("half-duplex\n"));
 631                                 else
 632                                         printf("Port %d Link Down\n", portid);
 633                                 continue;
 634                         }
 635                         /* Clear all_ports_up flag if any link down */
 636                         if (link.link_status == ETH_LINK_DOWN) {
 637                                 all_ports_up = 0;
 638                                 break;
 639                         }
 640                 }
 641                 /* After finally printing all link status, get out */
 642                 if (print_flag == 1)
 643                         break;
 644
 645                 if (all_ports_up == 0) {
 646                         printf(".");
 647                         fflush(stdout);
 648                         rte_delay_ms(CHECK_INTERVAL);
 649                 }
 650
 651                 /* Set the print_flag if all ports up or timeout */
 652                 if (all_ports_up == 1 || count == (MAX_CHECK_TIME - 1)) {
 653                         print_flag = 1;
 654                         printf("Done\n");
 655                 }
 656         }
 657 }
 658
 659 static void
 660 signal_handler(int signum)
 661 {
 662         if (signum == SIGINT || signum == SIGTERM) {
 663                 printf("\n\nSignal %d received, preparing to exit...\n",
 664                        signum);
 665                 force_quit = true;
 666         }
 667 }
 668
 669 static void
 670 print_stats(void)
 671 {
 672         const char topLeft[] = {27, '[', '1', ';', '1', 'H', '\0'};
 673         const char clr[] = {27, '[', '2', 'J', '\0'};
 674         struct rte_graph_cluster_stats_param s_param;
 675         struct rte_graph_cluster_stats *stats;
 676         const char *pattern = "worker_*";
 677
 678         /* Prepare stats object */
 679         memset(&s_param, 0, sizeof(s_param));
 680         s_param.f = stdout;
 681         s_param.socket_id = SOCKET_ID_ANY;
 682         s_param.graph_patterns = &pattern;
 683         s_param.nb_graph_patterns = 1;
 684
 685         stats = rte_graph_cluster_stats_create(&s_param);
 686         if (stats == NULL)
 687                 rte_exit(EXIT_FAILURE, "Unable to create stats object\n");
 688
 689         while (!force_quit) {
 690                 /* Clear screen and move to top left */
 691                 printf("%s%s", clr, topLeft);
 692                 rte_graph_cluster_stats_get(stats, 0);
 693                 rte_delay_ms(1E3);
 694         }
 695
 696         rte_graph_cluster_stats_destroy(stats);
 697 }
 698
 699 /* Main processing loop */
 700 static int
 701 graph_main_loop(void *conf)
 702 {
 703         struct lcore_conf *qconf;
 704         struct rte_graph *graph;
 705         uint32_t lcore_id;
 706
 707         RTE_SET_USED(conf);
 708
 709         lcore_id = rte_lcore_id();
 710         qconf = &lcore_conf[lcore_id];
 711         graph = qconf->graph;
 712
 713         if (!graph) {
 714                 RTE_LOG(INFO, L3FWD_GRAPH, "Lcore %u has nothing to do\n",
 715                         lcore_id);
 716                 return 0;
 717         }
 718
 719         RTE_LOG(INFO, L3FWD_GRAPH,
 720                 "Entering main loop on lcore %u, graph %s(%p)\n", lcore_id,
 721                 qconf->name, graph);
 722
 723         while (likely(!force_quit))
 724                 rte_graph_walk(graph);
 725
 726         return 0;
 727 }
 728
 729 int
 730 main(int argc, char **argv)
 731 {
 732         /* Rewrite data of src and dst ether addr */
 733         uint8_t rewrite_data[2 * sizeof(struct rte_ether_addr)];
 734         static const char * const default_patterns[] = {
 735                 "ip4*",
 736                 "ethdev_tx-*",
 737                 "pkt_drop",
 738         };
 739         uint8_t nb_rx_queue, queue, socketid;
 740         struct rte_graph_param graph_conf;
 741         struct rte_eth_dev_info dev_info;
 742         uint32_t nb_ports, nb_conf = 0;
 743         uint32_t n_tx_queue, nb_lcores;
 744         struct rte_eth_txconf *txconf;
 745         uint16_t queueid, portid, i;
 746         const char **node_patterns;
 747         struct lcore_conf *qconf;
 748         uint16_t nb_graphs = 0;
 749         uint16_t nb_patterns;
 750         uint8_t rewrite_len;
 751         uint32_t lcore_id;
 752         int ret;
 753
 754         /* Init EAL */
 755         ret = rte_eal_init(argc, argv);
 756         if (ret < 0)
 757                 rte_exit(EXIT_FAILURE, "Invalid EAL parameters\n");
 758         argc -= ret;
 759         argv += ret;
 760
 761         force_quit = false;
 762         signal(SIGINT, signal_handler);
 763         signal(SIGTERM, signal_handler);
 764
 765         /* Pre-init dst MACs for all ports to 02:00:00:00:00:xx */
 766         for (portid = 0; portid < RTE_MAX_ETHPORTS; portid++) {
 767                 dest_eth_addr[portid] =
 768                         RTE_ETHER_LOCAL_ADMIN_ADDR + ((uint64_t)portid << 40);
 769                 *(uint64_t *)(val_eth + portid) = dest_eth_addr[portid];
 770         }
 771
 772         /* Parse application arguments (after the EAL ones) */
 773         ret = parse_args(argc, argv);
 774         if (ret < 0)
 775                 rte_exit(EXIT_FAILURE, "Invalid L3FWD_GRAPH parameters\n");
 776
 777         if (check_lcore_params() < 0)
 778                 rte_exit(EXIT_FAILURE, "check_lcore_params() failed\n");
 779
 780         ret = init_lcore_rx_queues();
 781         if (ret < 0)
 782                 rte_exit(EXIT_FAILURE, "init_lcore_rx_queues() failed\n");
 783
 784         if (check_port_config() < 0)
 785                 rte_exit(EXIT_FAILURE, "check_port_config() failed\n");
 786
 787         nb_ports = rte_eth_dev_count_avail();
 788         nb_lcores = rte_lcore_count();
 789
 790         /* Initialize all ports */
 791         RTE_ETH_FOREACH_DEV(portid)
 792         {
 793                 struct rte_eth_conf local_port_conf = port_conf;
 794
 795                 /* Skip ports that are not enabled */
 796                 if ((enabled_port_mask & (1 << portid)) == 0) {
 797                         printf("\nSkipping disabled port %d\n", portid);
 798                         continue;
 799                 }
 800
 801                 /* Init port */
 802                 printf("Initializing port %d ... ", portid);
 803                 fflush(stdout);
 804
 805                 nb_rx_queue = get_port_n_rx_queues(portid);
 806                 n_tx_queue = nb_lcores;
 807                 if (n_tx_queue > MAX_TX_QUEUE_PER_PORT)
 808                         n_tx_queue = MAX_TX_QUEUE_PER_PORT;
 809                 printf("Creating queues: nb_rxq=%d nb_txq=%u... ",
 810                        nb_rx_queue, n_tx_queue);
 811
 812                 rte_eth_dev_info_get(portid, &dev_info);
 813                 if (dev_info.tx_offload_capa & DEV_TX_OFFLOAD_MBUF_FAST_FREE)
 814                         local_port_conf.txmode.offloads |=
 815                                 DEV_TX_OFFLOAD_MBUF_FAST_FREE;
 816
 817                 local_port_conf.rx_adv_conf.rss_conf.rss_hf &=
 818                         dev_info.flow_type_rss_offloads;
 819                 if (local_port_conf.rx_adv_conf.rss_conf.rss_hf !=
 820                     port_conf.rx_adv_conf.rss_conf.rss_hf) {
 821                         printf("Port %u modified RSS hash function based on "
 822                                "hardware support,"
 823                                "requested:%#" PRIx64 " configured:%#" PRIx64
 824                                "\n",
 825                                portid, port_conf.rx_adv_conf.rss_conf.rss_hf,
 826                                local_port_conf.rx_adv_conf.rss_conf.rss_hf);
 827                 }
 828
 829                 ret = rte_eth_dev_configure(portid, nb_rx_queue,
 830                                             n_tx_queue, &local_port_conf);
 831                 if (ret < 0)
 832                         rte_exit(EXIT_FAILURE,
 833                                  "Cannot configure device: err=%d, port=%d\n",
 834                                  ret, portid);
 835
 836                 ret = rte_eth_dev_adjust_nb_rx_tx_desc(portid, &nb_rxd,
 837                                                        &nb_txd);
 838                 if (ret < 0)
 839                         rte_exit(EXIT_FAILURE,
 840                                  "Cannot adjust number of descriptors: err=%d, "
 841                                  "port=%d\n",
 842                                  ret, portid);
 843
 844                 rte_eth_macaddr_get(portid, &ports_eth_addr[portid]);
 845                 print_ethaddr(" Address:", &ports_eth_addr[portid]);
 846                 printf(", ");
 847                 print_ethaddr(
 848                         "Destination:",
 849                         (const struct rte_ether_addr *)&dest_eth_addr[portid]);
 850                 printf(", ");
 851
 852                 /*
 853                  * prepare src MACs for each port.
 854                  */
 855                 rte_ether_addr_copy(
 856                         &ports_eth_addr[portid],
 857                         (struct rte_ether_addr *)(val_eth + portid) + 1);
 858
 859                 /* Init memory */
 860                 if (!per_port_pool) {
 861                         /* portid = 0; this is *not* signifying the first port,
 862                          * rather, it signifies that portid is ignored.
 863                          */
 864                         ret = init_mem(0, NB_MBUF(nb_ports));
 865                 } else {
 866                         ret = init_mem(portid, NB_MBUF(1));
 867                 }
 868                 if (ret < 0)
 869                         rte_exit(EXIT_FAILURE, "init_mem() failed\n");
 870
 871                 /* Init one TX queue per couple (lcore,port) */
 872                 queueid = 0;
 873                 for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++) {
 874                         if (rte_lcore_is_enabled(lcore_id) == 0)
 875                                 continue;
 876
 877                         qconf = &lcore_conf[lcore_id];
 878
 879                         if (numa_on)
 880                                 socketid = (uint8_t)rte_lcore_to_socket_id(
 881                                         lcore_id);
 882                         else
 883                                 socketid = 0;
 884
 885                         printf("txq=%u,%d,%d ", lcore_id, queueid, socketid);
 886                         fflush(stdout);
 887
 888                         txconf = &dev_info.default_txconf;
 889                         txconf->offloads = local_port_conf.txmode.offloads;
 890                         ret = rte_eth_tx_queue_setup(portid, queueid, nb_txd,
 891                                                      socketid, txconf);
 892                         if (ret < 0)
 893                                 rte_exit(EXIT_FAILURE,
 894                                          "rte_eth_tx_queue_setup: err=%d, "
 895                                          "port=%d\n",
 896                                          ret, portid);
 897                         queueid++;
 898                 }
 899
 900                 /* Setup ethdev node config */
 901                 ethdev_conf[nb_conf].port_id = portid;
 902                 ethdev_conf[nb_conf].num_rx_queues = nb_rx_queue;
 903                 ethdev_conf[nb_conf].num_tx_queues = n_tx_queue;
 904                 if (!per_port_pool)
 905                         ethdev_conf[nb_conf].mp = pktmbuf_pool[0];
 906
 907                 else
 908                         ethdev_conf[nb_conf].mp = pktmbuf_pool[portid];
 909                 ethdev_conf[nb_conf].mp_count = NB_SOCKETS;
 910
 911                 nb_conf++;
 912                 printf("\n");
 913         }
 914
 915         for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++) {
 916                 if (rte_lcore_is_enabled(lcore_id) == 0)
 917                         continue;
 918                 qconf = &lcore_conf[lcore_id];
 919                 printf("\nInitializing rx queues on lcore %u ... ", lcore_id);
 920                 fflush(stdout);
 921                 /* Init RX queues */
 922                 for (queue = 0; queue < qconf->n_rx_queue; ++queue) {
 923                         struct rte_eth_rxconf rxq_conf;
 924
 925                         portid = qconf->rx_queue_list[queue].port_id;
 926                         queueid = qconf->rx_queue_list[queue].queue_id;
 927
 928                         if (numa_on)
 929                                 socketid = (uint8_t)rte_lcore_to_socket_id(
 930                                         lcore_id);
 931                         else
 932                                 socketid = 0;
 933
 934                         printf("rxq=%d,%d,%d ", portid, queueid, socketid);
 935                         fflush(stdout);
 936
 937                         rte_eth_dev_info_get(portid, &dev_info);
 938                         rxq_conf = dev_info.default_rxconf;
 939                         rxq_conf.offloads = port_conf.rxmode.offloads;
 940                         if (!per_port_pool)
 941                                 ret = rte_eth_rx_queue_setup(
 942                                         portid, queueid, nb_rxd, socketid,
 943                                         &rxq_conf, pktmbuf_pool[0][socketid]);
 944                         else
 945                                 ret = rte_eth_rx_queue_setup(
 946                                         portid, queueid, nb_rxd, socketid,
 947                                         &rxq_conf,
 948                                         pktmbuf_pool[portid][socketid]);
 949                         if (ret < 0)
 950                                 rte_exit(EXIT_FAILURE,
 951                                          "rte_eth_rx_queue_setup: err=%d, "
 952                                          "port=%d\n",
 953                                          ret, portid);
 954
 955                         /* Add this queue node to its graph */
 956                         snprintf(qconf->rx_queue_list[queue].node_name,
 957                                  RTE_NODE_NAMESIZE, "ethdev_rx-%u-%u", portid,
 958                                  queueid);
 959                 }
 960
 961                 /* Alloc a graph to this lcore only if source exists  */
 962                 if (qconf->n_rx_queue)
 963                         nb_graphs++;
 964         }
 965
 966         printf("\n");
 967
 968         /* Ethdev node config, skip rx queue mapping */
 969         ret = rte_node_eth_config(ethdev_conf, nb_conf, nb_graphs);
 970         if (ret)
 971                 rte_exit(EXIT_FAILURE, "rte_node_eth_config: err=%d\n", ret);
 972
 973         /* Start ports */
 974         RTE_ETH_FOREACH_DEV(portid)
 975         {
 976                 if ((enabled_port_mask & (1 << portid)) == 0)
 977                         continue;
 978
 979                 /* Start device */
 980                 ret = rte_eth_dev_start(portid);
 981                 if (ret < 0)
 982                         rte_exit(EXIT_FAILURE,
 983                                  "rte_eth_dev_start: err=%d, port=%d\n", ret,
 984                                  portid);
 985
 986                 /*
 987                  * If enabled, put device in promiscuous mode.
 988                  * This allows IO forwarding mode to forward packets
 989                  * to itself through 2 cross-connected  ports of the
 990                  * target machine.
 991                  */
 992                 if (promiscuous_on)
 993                         rte_eth_promiscuous_enable(portid);
 994         }
 995
 996         printf("\n");
 997
 998         check_all_ports_link_status(enabled_port_mask);
 999
1000         /* Graph Initialization */
1001         nb_patterns = RTE_DIM(default_patterns);
1002         node_patterns = malloc((MAX_RX_QUEUE_PER_LCORE + nb_patterns) *
1003                                sizeof(*node_patterns));
1004         if (!node_patterns)
1005                 return -ENOMEM;
1006         memcpy(node_patterns, default_patterns,
1007                nb_patterns * sizeof(*node_patterns));
1008
1009         memset(&graph_conf, 0, sizeof(graph_conf));
1010         graph_conf.node_patterns = node_patterns;
1011
1012         for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++) {
1013                 rte_graph_t graph_id;
1014                 rte_edge_t i;
1015
1016                 if (rte_lcore_is_enabled(lcore_id) == 0)
1017                         continue;
1018
1019                 qconf = &lcore_conf[lcore_id];
1020
1021                 /* Skip graph creation if no source exists */
1022                 if (!qconf->n_rx_queue)
1023                         continue;
1024
1025                 /* Add rx node patterns of this lcore */
1026                 for (i = 0; i < qconf->n_rx_queue; i++) {
1027                         graph_conf.node_patterns[nb_patterns + i] =
1028                                 qconf->rx_queue_list[i].node_name;
1029                 }
1030
1031                 graph_conf.nb_node_patterns = nb_patterns + i;
1032                 graph_conf.socket_id = rte_lcore_to_socket_id(lcore_id);
1033
1034                 snprintf(qconf->name, sizeof(qconf->name), "worker_%u",
1035                          lcore_id);
1036
1037                 graph_id = rte_graph_create(qconf->name, &graph_conf);
1038                 if (graph_id == RTE_GRAPH_ID_INVALID)
1039                         rte_exit(EXIT_FAILURE,
1040                                  "rte_graph_create(): graph_id invalid"
1041                                  " for lcore %u\n", lcore_id);
1042
1043                 qconf->graph_id = graph_id;
1044                 qconf->graph = rte_graph_lookup(qconf->name);
1045                 if (!qconf->graph)
1046                         rte_exit(EXIT_FAILURE,
1047                                  "rte_graph_lookup(): graph %s not found\n",
1048                                  qconf->name);
1049         }
1050
1051         memset(&rewrite_data, 0, sizeof(rewrite_data));
1052         rewrite_len = sizeof(rewrite_data);
1053
1054         /* Add route to ip4 graph infra */
1055         for (i = 0; i < IPV4_L3FWD_LPM_NUM_ROUTES; i++) {
1056                 char route_str[INET6_ADDRSTRLEN * 4];
1057                 char abuf[INET6_ADDRSTRLEN];
1058                 struct in_addr in;
1059                 uint32_t dst_port;
1060
1061                 /* Skip unused ports */
1062                 if ((1 << ipv4_l3fwd_lpm_route_array[i].if_out &
1063                      enabled_port_mask) == 0)
1064                         continue;
1065
1066                 dst_port = ipv4_l3fwd_lpm_route_array[i].if_out;
1067
1068                 in.s_addr = htonl(ipv4_l3fwd_lpm_route_array[i].ip);
1069                 snprintf(route_str, sizeof(route_str), "%s / %d (%d)",
1070                          inet_ntop(AF_INET, &in, abuf, sizeof(abuf)),
1071                          ipv4_l3fwd_lpm_route_array[i].depth,
1072                          ipv4_l3fwd_lpm_route_array[i].if_out);
1073
1074                 /* Use route index 'i' as next hop id */
1075                 ret = rte_node_ip4_route_add(
1076                         ipv4_l3fwd_lpm_route_array[i].ip,
1077                         ipv4_l3fwd_lpm_route_array[i].depth, i,
1078                         RTE_NODE_IP4_LOOKUP_NEXT_REWRITE);
1079
1080                 if (ret < 0)
1081                         rte_exit(EXIT_FAILURE,
1082                                  "Unable to add ip4 route %s to graph\n",
1083                                  route_str);
1084
1085                 memcpy(rewrite_data, val_eth + dst_port, rewrite_len);
1086
1087                 /* Add next hop rewrite data for id 'i' */
1088                 ret = rte_node_ip4_rewrite_add(i, rewrite_data,
1089                                                rewrite_len, dst_port);
1090                 if (ret < 0)
1091                         rte_exit(EXIT_FAILURE,
1092                                  "Unable to add next hop %u for "
1093                                  "route %s\n", i, route_str);
1094
1095                 RTE_LOG(INFO, L3FWD_GRAPH, "Added route %s, next_hop %u\n",
1096                         route_str, i);
1097         }
1098
1099         /* Launch per-lcore init on every slave lcore */
1100         rte_eal_mp_remote_launch(graph_main_loop, NULL, SKIP_MASTER);
1101
1102         /* Accumulate and print stats on master until exit */
1103         if (rte_graph_has_stats_feature())
1104                 print_stats();
1105
1106         /* Wait for slave cores to exit */
1107         ret = 0;
1108         RTE_LCORE_FOREACH_SLAVE(lcore_id) {
1109                 ret = rte_eal_wait_lcore(lcore_id);
1110                 /* Destroy graph */
1111                 if (ret < 0 || rte_graph_destroy(
1112                         rte_graph_from_name(lcore_conf[lcore_id].name))) {
1113                         ret = -1;
1114                         break;
1115                 }
1116         }
1117         free(node_patterns);
1118
1119         /* Stop ports */
1120         RTE_ETH_FOREACH_DEV(portid) {
1121                 if ((enabled_port_mask & (1 << portid)) == 0)
1122                         continue;
1123                 printf("Closing port %d...", portid);
1124                 rte_eth_dev_stop(portid);
1125                 rte_eth_dev_close(portid);
1126                 printf(" Done\n");
1127         }
1128         printf("Bye...\n");
1129
1130         return ret;
1131 }