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 -1;
 306
 307         if (pm == 0)
 308                 return -1;
 309
 310         return pm;
 311 }
 312
 313 static int
 314 parse_config(const char *q_arg)
 315 {
 316         enum fieldnames { FLD_PORT = 0, FLD_QUEUE, FLD_LCORE, _NUM_FLD };
 317         unsigned long int_fld[_NUM_FLD];
 318         const char *p, *p0 = q_arg;
 319         char *str_fld[_NUM_FLD];
 320         uint32_t size;
 321         char s[256];
 322         char *end;
 323         int i;
 324
 325         nb_lcore_params = 0;
 326
 327         while ((p = strchr(p0, '(')) != NULL) {
 328                 ++p;
 329                 p0 = strchr(p, ')');
 330                 if (p0 == NULL)
 331                         return -1;
 332
 333                 size = p0 - p;
 334                 if (size >= sizeof(s))
 335                         return -1;
 336
 337                 memcpy(s, p, size);
 338                 s[size] = '\0';
 339                 if (rte_strsplit(s, sizeof(s), str_fld, _NUM_FLD, ',') !=
 340                     _NUM_FLD)
 341                         return -1;
 342                 for (i = 0; i < _NUM_FLD; i++) {
 343                         errno = 0;
 344                         int_fld[i] = strtoul(str_fld[i], &end, 0);
 345                         if (errno != 0 || end == str_fld[i])
 346                                 return -1;
 347                 }
 348
 349                 if (nb_lcore_params >= MAX_LCORE_PARAMS) {
 350                         printf("Exceeded max number of lcore params: %hu\n",
 351                                nb_lcore_params);
 352                         return -1;
 353                 }
 354
 355                 if (int_fld[FLD_PORT] >= RTE_MAX_ETHPORTS ||
 356                     int_fld[FLD_LCORE] >= RTE_MAX_LCORE) {
 357                         printf("Invalid port/lcore id\n");
 358                         return -1;
 359                 }
 360
 361                 lcore_params_array[nb_lcore_params].port_id =
 362                         (uint8_t)int_fld[FLD_PORT];
 363                 lcore_params_array[nb_lcore_params].queue_id =
 364                         (uint8_t)int_fld[FLD_QUEUE];
 365                 lcore_params_array[nb_lcore_params].lcore_id =
 366                         (uint8_t)int_fld[FLD_LCORE];
 367                 ++nb_lcore_params;
 368         }
 369         lcore_params = lcore_params_array;
 370
 371         return 0;
 372 }
 373
 374 static void
 375 parse_eth_dest(const char *optarg)
 376 {
 377         uint8_t c, *dest, peer_addr[6];
 378         uint16_t portid;
 379         char *port_end;
 380
 381         errno = 0;
 382         portid = strtoul(optarg, &port_end, 10);
 383         if (errno != 0 || port_end == optarg || *port_end++ != ',')
 384                 rte_exit(EXIT_FAILURE, "Invalid eth-dest: %s", optarg);
 385         if (portid >= RTE_MAX_ETHPORTS)
 386                 rte_exit(EXIT_FAILURE,
 387                          "eth-dest: port %d >= RTE_MAX_ETHPORTS(%d)\n", portid,
 388                          RTE_MAX_ETHPORTS);
 389
 390         if (cmdline_parse_etheraddr(NULL, port_end, &peer_addr,
 391                                     sizeof(peer_addr)) < 0)
 392                 rte_exit(EXIT_FAILURE, "Invalid ethernet address: %s\n",
 393                          port_end);
 394         dest = (uint8_t *)&dest_eth_addr[portid];
 395         for (c = 0; c < 6; c++)
 396                 dest[c] = peer_addr[c];
 397         *(uint64_t *)(val_eth + portid) = dest_eth_addr[portid];
 398 }
 399
 400 #define MAX_JUMBO_PKT_LEN  9600
 401 #define MEMPOOL_CACHE_SIZE 256
 402
 403 static const char short_options[] = "p:" /* portmask */
 404                                     "P"  /* promiscuous */
 405         ;
 406
 407 #define CMD_LINE_OPT_CONFIG        "config"
 408 #define CMD_LINE_OPT_ETH_DEST      "eth-dest"
 409 #define CMD_LINE_OPT_NO_NUMA       "no-numa"
 410 #define CMD_LINE_OPT_ENABLE_JUMBO  "enable-jumbo"
 411 #define CMD_LINE_OPT_PER_PORT_POOL "per-port-pool"
 412 enum {
 413         /* Long options mapped to a short option */
 414
 415         /* First long only option value must be >= 256, so that we won't
 416          * conflict with short options
 417          */
 418         CMD_LINE_OPT_MIN_NUM = 256,
 419         CMD_LINE_OPT_CONFIG_NUM,
 420         CMD_LINE_OPT_ETH_DEST_NUM,
 421         CMD_LINE_OPT_NO_NUMA_NUM,
 422         CMD_LINE_OPT_ENABLE_JUMBO_NUM,
 423         CMD_LINE_OPT_PARSE_PER_PORT_POOL,
 424 };
 425
 426 static const struct option lgopts[] = {
 427         {CMD_LINE_OPT_CONFIG, 1, 0, CMD_LINE_OPT_CONFIG_NUM},
 428         {CMD_LINE_OPT_ETH_DEST, 1, 0, CMD_LINE_OPT_ETH_DEST_NUM},
 429         {CMD_LINE_OPT_NO_NUMA, 0, 0, CMD_LINE_OPT_NO_NUMA_NUM},
 430         {CMD_LINE_OPT_ENABLE_JUMBO, 0, 0, CMD_LINE_OPT_ENABLE_JUMBO_NUM},
 431         {CMD_LINE_OPT_PER_PORT_POOL, 0, 0, CMD_LINE_OPT_PARSE_PER_PORT_POOL},
 432         {NULL, 0, 0, 0},
 433 };
 434
 435 /*
 436  * This expression is used to calculate the number of mbufs needed
 437  * depending on user input, taking  into account memory for rx and
 438  * tx hardware rings, cache per lcore and mtable per port per lcore.
 439  * RTE_MAX is used to ensure that NB_MBUF never goes below a minimum
 440  * value of 8192
 441  */
 442 #define NB_MBUF(nports)                                                        \
 443         RTE_MAX((nports * nb_rx_queue * nb_rxd +                               \
 444                  nports * nb_lcores * RTE_GRAPH_BURST_SIZE +                   \
 445                  nports * n_tx_queue * nb_txd +                                \
 446                  nb_lcores * MEMPOOL_CACHE_SIZE), 8192u)
 447
 448 /* Parse the argument given in the command line of the application */
 449 static int
 450 parse_args(int argc, char **argv)
 451 {
 452         char *prgname = argv[0];
 453         int option_index;
 454         char **argvopt;
 455         int opt, ret;
 456
 457         argvopt = argv;
 458
 459         /* Error or normal output strings. */
 460         while ((opt = getopt_long(argc, argvopt, short_options, lgopts,
 461                                   &option_index)) != EOF) {
 462
 463                 switch (opt) {
 464                 /* Portmask */
 465                 case 'p':
 466                         enabled_port_mask = parse_portmask(optarg);
 467                         if (enabled_port_mask == 0) {
 468                                 fprintf(stderr, "Invalid portmask\n");
 469                                 print_usage(prgname);
 470                                 return -1;
 471                         }
 472                         break;
 473
 474                 case 'P':
 475                         promiscuous_on = 1;
 476                         break;
 477
 478                 /* Long options */
 479                 case CMD_LINE_OPT_CONFIG_NUM:
 480                         ret = parse_config(optarg);
 481                         if (ret) {
 482                                 fprintf(stderr, "Invalid config\n");
 483                                 print_usage(prgname);
 484                                 return -1;
 485                         }
 486                         break;
 487
 488                 case CMD_LINE_OPT_ETH_DEST_NUM:
 489                         parse_eth_dest(optarg);
 490                         break;
 491
 492                 case CMD_LINE_OPT_NO_NUMA_NUM:
 493                         numa_on = 0;
 494                         break;
 495
 496                 case CMD_LINE_OPT_ENABLE_JUMBO_NUM: {
 497                         const struct option lenopts = {"max-pkt-len",
 498                                                        required_argument, 0, 0};
 499
 500                         port_conf.rxmode.offloads |= DEV_RX_OFFLOAD_JUMBO_FRAME;
 501                         port_conf.txmode.offloads |= DEV_TX_OFFLOAD_MULTI_SEGS;
 502
 503                         /*
 504                          * if no max-pkt-len set, use the default
 505                          * value RTE_ETHER_MAX_LEN.
 506                          */
 507                         if (getopt_long(argc, argvopt, "", &lenopts,
 508                                         &option_index) == 0) {
 509                                 ret = parse_max_pkt_len(optarg);
 510                                 if (ret < 64 || ret > MAX_JUMBO_PKT_LEN) {
 511                                         fprintf(stderr, "Invalid maximum "
 512                                                         "packet length\n");
 513                                         print_usage(prgname);
 514                                         return -1;
 515                                 }
 516                                 port_conf.rxmode.max_rx_pkt_len = ret;
 517                         }
 518                         break;
 519                 }
 520
 521                 case CMD_LINE_OPT_PARSE_PER_PORT_POOL:
 522                         printf("Per port buffer pool is enabled\n");
 523                         per_port_pool = 1;
 524                         break;
 525
 526                 default:
 527                         print_usage(prgname);
 528                         return -1;
 529                 }
 530         }
 531
 532         if (optind >= 0)
 533                 argv[optind - 1] = prgname;
 534         ret = optind - 1;
 535         optind = 1; /* Reset getopt lib */
 536
 537         return ret;
 538 }
 539
 540 static void
 541 print_ethaddr(const char *name, const struct rte_ether_addr *eth_addr)
 542 {
 543         char buf[RTE_ETHER_ADDR_FMT_SIZE];
 544         rte_ether_format_addr(buf, RTE_ETHER_ADDR_FMT_SIZE, eth_addr);
 545         printf("%s%s", name, buf);
 546 }
 547
 548 static int
 549 init_mem(uint16_t portid, uint32_t nb_mbuf)
 550 {
 551         uint32_t lcore_id;
 552         int socketid;
 553         char s[64];
 554
 555         for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++) {
 556                 if (rte_lcore_is_enabled(lcore_id) == 0)
 557                         continue;
 558
 559                 if (numa_on)
 560                         socketid = rte_lcore_to_socket_id(lcore_id);
 561                 else
 562                         socketid = 0;
 563
 564                 if (socketid >= NB_SOCKETS) {
 565                         rte_exit(EXIT_FAILURE,
 566                                  "Socket %d of lcore %u is out of range %d\n",
 567                                  socketid, lcore_id, NB_SOCKETS);
 568                 }
 569
 570                 if (pktmbuf_pool[portid][socketid] == NULL) {
 571                         snprintf(s, sizeof(s), "mbuf_pool_%d:%d", portid,
 572                                  socketid);
 573                         /* Create a pool with priv size of a cacheline */
 574                         pktmbuf_pool[portid][socketid] =
 575                                 rte_pktmbuf_pool_create(
 576                                         s, nb_mbuf, MEMPOOL_CACHE_SIZE,
 577                                         RTE_CACHE_LINE_SIZE,
 578                                         RTE_MBUF_DEFAULT_BUF_SIZE, socketid);
 579                         if (pktmbuf_pool[portid][socketid] == NULL)
 580                                 rte_exit(EXIT_FAILURE,
 581                                          "Cannot init mbuf pool on socket %d\n",
 582                                          socketid);
 583                         else
 584                                 printf("Allocated mbuf pool on socket %d\n",
 585                                        socketid);
 586                 }
 587         }
 588
 589         return 0;
 590 }
 591
 592 /* Check the link status of all ports in up to 9s, and print them finally */
 593 static void
 594 check_all_ports_link_status(uint32_t port_mask)
 595 {
 596 #define CHECK_INTERVAL 100 /* 100ms */
 597 #define MAX_CHECK_TIME 90  /* 9s (90 * 100ms) in total */
 598         uint8_t count, all_ports_up, print_flag = 0;
 599         struct rte_eth_link link;
 600         uint16_t portid;
 601         int ret;
 602
 603         printf("\nChecking link status");
 604         fflush(stdout);
 605         for (count = 0; count <= MAX_CHECK_TIME; count++) {
 606                 if (force_quit)
 607                         return;
 608                 all_ports_up = 1;
 609                 RTE_ETH_FOREACH_DEV(portid)
 610                 {
 611                         if (force_quit)
 612                                 return;
 613                         if ((port_mask & (1 << portid)) == 0)
 614                                 continue;
 615                         memset(&link, 0, sizeof(link));
 616                         ret = rte_eth_link_get_nowait(portid, &link);
 617                         if (ret < 0) {
 618                                 all_ports_up = 0;
 619                                 if (print_flag == 1)
 620                                         printf("Port %u link get failed: %s\n",
 621                                                 portid, rte_strerror(-ret));
 622                                 continue;
 623                         }
 624                         /* Print link status if flag set */
 625                         if (print_flag == 1) {
 626                                 if (link.link_status)
 627                                         printf("Port%d Link Up. Speed %u Mbps "
 628                                                "-%s\n",
 629                                                portid, link.link_speed,
 630                                                (link.link_duplex ==
 631                                                 ETH_LINK_FULL_DUPLEX)
 632                                                        ? ("full-duplex")
 633                                                        : ("half-duplex\n"));
 634                                 else
 635                                         printf("Port %d Link Down\n", portid);
 636                                 continue;
 637                         }
 638                         /* Clear all_ports_up flag if any link down */
 639                         if (link.link_status == ETH_LINK_DOWN) {
 640                                 all_ports_up = 0;
 641                                 break;
 642                         }
 643                 }
 644                 /* After finally printing all link status, get out */
 645                 if (print_flag == 1)
 646                         break;
 647
 648                 if (all_ports_up == 0) {
 649                         printf(".");
 650                         fflush(stdout);
 651                         rte_delay_ms(CHECK_INTERVAL);
 652                 }
 653
 654                 /* Set the print_flag if all ports up or timeout */
 655                 if (all_ports_up == 1 || count == (MAX_CHECK_TIME - 1)) {
 656                         print_flag = 1;
 657                         printf("Done\n");
 658                 }
 659         }
 660 }
 661
 662 static void
 663 signal_handler(int signum)
 664 {
 665         if (signum == SIGINT || signum == SIGTERM) {
 666                 printf("\n\nSignal %d received, preparing to exit...\n",
 667                        signum);
 668                 force_quit = true;
 669         }
 670 }
 671
 672 static void
 673 print_stats(void)
 674 {
 675         const char topLeft[] = {27, '[', '1', ';', '1', 'H', '\0'};
 676         const char clr[] = {27, '[', '2', 'J', '\0'};
 677         struct rte_graph_cluster_stats_param s_param;
 678         struct rte_graph_cluster_stats *stats;
 679         const char *pattern = "worker_*";
 680
 681         /* Prepare stats object */
 682         memset(&s_param, 0, sizeof(s_param));
 683         s_param.f = stdout;
 684         s_param.socket_id = SOCKET_ID_ANY;
 685         s_param.graph_patterns = &pattern;
 686         s_param.nb_graph_patterns = 1;
 687
 688         stats = rte_graph_cluster_stats_create(&s_param);
 689         if (stats == NULL)
 690                 rte_exit(EXIT_FAILURE, "Unable to create stats object\n");
 691
 692         while (!force_quit) {
 693                 /* Clear screen and move to top left */
 694                 printf("%s%s", clr, topLeft);
 695                 rte_graph_cluster_stats_get(stats, 0);
 696                 rte_delay_ms(1E3);
 697         }
 698
 699         rte_graph_cluster_stats_destroy(stats);
 700 }
 701
 702 /* Main processing loop */
 703 static int
 704 graph_main_loop(void *conf)
 705 {
 706         struct lcore_conf *qconf;
 707         struct rte_graph *graph;
 708         uint32_t lcore_id;
 709
 710         RTE_SET_USED(conf);
 711
 712         lcore_id = rte_lcore_id();
 713         qconf = &lcore_conf[lcore_id];
 714         graph = qconf->graph;
 715
 716         if (!graph) {
 717                 RTE_LOG(INFO, L3FWD_GRAPH, "Lcore %u has nothing to do\n",
 718                         lcore_id);
 719                 return 0;
 720         }
 721
 722         RTE_LOG(INFO, L3FWD_GRAPH,
 723                 "Entering main loop on lcore %u, graph %s(%p)\n", lcore_id,
 724                 qconf->name, graph);
 725
 726         while (likely(!force_quit))
 727                 rte_graph_walk(graph);
 728
 729         return 0;
 730 }
 731
 732 int
 733 main(int argc, char **argv)
 734 {
 735         /* Rewrite data of src and dst ether addr */
 736         uint8_t rewrite_data[2 * sizeof(struct rte_ether_addr)];
 737         static const char * const default_patterns[] = {
 738                 "ip4*",
 739                 "ethdev_tx-*",
 740                 "pkt_drop",
 741         };
 742         uint8_t nb_rx_queue, queue, socketid;
 743         struct rte_graph_param graph_conf;
 744         struct rte_eth_dev_info dev_info;
 745         uint32_t nb_ports, nb_conf = 0;
 746         uint32_t n_tx_queue, nb_lcores;
 747         struct rte_eth_txconf *txconf;
 748         uint16_t queueid, portid, i;
 749         const char **node_patterns;
 750         struct lcore_conf *qconf;
 751         uint16_t nb_graphs = 0;
 752         uint16_t nb_patterns;
 753         uint8_t rewrite_len;
 754         uint32_t lcore_id;
 755         int ret;
 756
 757         /* Init EAL */
 758         ret = rte_eal_init(argc, argv);
 759         if (ret < 0)
 760                 rte_exit(EXIT_FAILURE, "Invalid EAL parameters\n");
 761         argc -= ret;
 762         argv += ret;
 763
 764         force_quit = false;
 765         signal(SIGINT, signal_handler);
 766         signal(SIGTERM, signal_handler);
 767
 768         /* Pre-init dst MACs for all ports to 02:00:00:00:00:xx */
 769         for (portid = 0; portid < RTE_MAX_ETHPORTS; portid++) {
 770                 dest_eth_addr[portid] =
 771                         RTE_ETHER_LOCAL_ADMIN_ADDR + ((uint64_t)portid << 40);
 772                 *(uint64_t *)(val_eth + portid) = dest_eth_addr[portid];
 773         }
 774
 775         /* Parse application arguments (after the EAL ones) */
 776         ret = parse_args(argc, argv);
 777         if (ret < 0)
 778                 rte_exit(EXIT_FAILURE, "Invalid L3FWD_GRAPH parameters\n");
 779
 780         if (check_lcore_params() < 0)
 781                 rte_exit(EXIT_FAILURE, "check_lcore_params() failed\n");
 782
 783         ret = init_lcore_rx_queues();
 784         if (ret < 0)
 785                 rte_exit(EXIT_FAILURE, "init_lcore_rx_queues() failed\n");
 786
 787         if (check_port_config() < 0)
 788                 rte_exit(EXIT_FAILURE, "check_port_config() failed\n");
 789
 790         nb_ports = rte_eth_dev_count_avail();
 791         nb_lcores = rte_lcore_count();
 792
 793         /* Initialize all ports */
 794         RTE_ETH_FOREACH_DEV(portid)
 795         {
 796                 struct rte_eth_conf local_port_conf = port_conf;
 797
 798                 /* Skip ports that are not enabled */
 799                 if ((enabled_port_mask & (1 << portid)) == 0) {
 800                         printf("\nSkipping disabled port %d\n", portid);
 801                         continue;
 802                 }
 803
 804                 /* Init port */
 805                 printf("Initializing port %d ... ", portid);
 806                 fflush(stdout);
 807
 808                 nb_rx_queue = get_port_n_rx_queues(portid);
 809                 n_tx_queue = nb_lcores;
 810                 if (n_tx_queue > MAX_TX_QUEUE_PER_PORT)
 811                         n_tx_queue = MAX_TX_QUEUE_PER_PORT;
 812                 printf("Creating queues: nb_rxq=%d nb_txq=%u... ",
 813                        nb_rx_queue, n_tx_queue);
 814
 815                 rte_eth_dev_info_get(portid, &dev_info);
 816                 if (dev_info.tx_offload_capa & DEV_TX_OFFLOAD_MBUF_FAST_FREE)
 817                         local_port_conf.txmode.offloads |=
 818                                 DEV_TX_OFFLOAD_MBUF_FAST_FREE;
 819
 820                 local_port_conf.rx_adv_conf.rss_conf.rss_hf &=
 821                         dev_info.flow_type_rss_offloads;
 822                 if (local_port_conf.rx_adv_conf.rss_conf.rss_hf !=
 823                     port_conf.rx_adv_conf.rss_conf.rss_hf) {
 824                         printf("Port %u modified RSS hash function based on "
 825                                "hardware support,"
 826                                "requested:%#" PRIx64 " configured:%#" PRIx64
 827                                "\n",
 828                                portid, port_conf.rx_adv_conf.rss_conf.rss_hf,
 829                                local_port_conf.rx_adv_conf.rss_conf.rss_hf);
 830                 }
 831
 832                 ret = rte_eth_dev_configure(portid, nb_rx_queue,
 833                                             n_tx_queue, &local_port_conf);
 834                 if (ret < 0)
 835                         rte_exit(EXIT_FAILURE,
 836                                  "Cannot configure device: err=%d, port=%d\n",
 837                                  ret, portid);
 838
 839                 ret = rte_eth_dev_adjust_nb_rx_tx_desc(portid, &nb_rxd,
 840                                                        &nb_txd);
 841                 if (ret < 0)
 842                         rte_exit(EXIT_FAILURE,
 843                                  "Cannot adjust number of descriptors: err=%d, "
 844                                  "port=%d\n",
 845                                  ret, portid);
 846
 847                 rte_eth_macaddr_get(portid, &ports_eth_addr[portid]);
 848                 print_ethaddr(" Address:", &ports_eth_addr[portid]);
 849                 printf(", ");
 850                 print_ethaddr(
 851                         "Destination:",
 852                         (const struct rte_ether_addr *)&dest_eth_addr[portid]);
 853                 printf(", ");
 854
 855                 /*
 856                  * prepare src MACs for each port.
 857                  */
 858                 rte_ether_addr_copy(
 859                         &ports_eth_addr[portid],
 860                         (struct rte_ether_addr *)(val_eth + portid) + 1);
 861
 862                 /* Init memory */
 863                 if (!per_port_pool) {
 864                         /* portid = 0; this is *not* signifying the first port,
 865                          * rather, it signifies that portid is ignored.
 866                          */
 867                         ret = init_mem(0, NB_MBUF(nb_ports));
 868                 } else {
 869                         ret = init_mem(portid, NB_MBUF(1));
 870                 }
 871                 if (ret < 0)
 872                         rte_exit(EXIT_FAILURE, "init_mem() failed\n");
 873
 874                 /* Init one TX queue per couple (lcore,port) */
 875                 queueid = 0;
 876                 for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++) {
 877                         if (rte_lcore_is_enabled(lcore_id) == 0)
 878                                 continue;
 879
 880                         qconf = &lcore_conf[lcore_id];
 881
 882                         if (numa_on)
 883                                 socketid = (uint8_t)rte_lcore_to_socket_id(
 884                                         lcore_id);
 885                         else
 886                                 socketid = 0;
 887
 888                         printf("txq=%u,%d,%d ", lcore_id, queueid, socketid);
 889                         fflush(stdout);
 890
 891                         txconf = &dev_info.default_txconf;
 892                         txconf->offloads = local_port_conf.txmode.offloads;
 893                         ret = rte_eth_tx_queue_setup(portid, queueid, nb_txd,
 894                                                      socketid, txconf);
 895                         if (ret < 0)
 896                                 rte_exit(EXIT_FAILURE,
 897                                          "rte_eth_tx_queue_setup: err=%d, "
 898                                          "port=%d\n",
 899                                          ret, portid);
 900                         queueid++;
 901                 }
 902
 903                 /* Setup ethdev node config */
 904                 ethdev_conf[nb_conf].port_id = portid;
 905                 ethdev_conf[nb_conf].num_rx_queues = nb_rx_queue;
 906                 ethdev_conf[nb_conf].num_tx_queues = n_tx_queue;
 907                 if (!per_port_pool)
 908                         ethdev_conf[nb_conf].mp = pktmbuf_pool[0];
 909
 910                 else
 911                         ethdev_conf[nb_conf].mp = pktmbuf_pool[portid];
 912                 ethdev_conf[nb_conf].mp_count = NB_SOCKETS;
 913
 914                 nb_conf++;
 915                 printf("\n");
 916         }
 917
 918         for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++) {
 919                 if (rte_lcore_is_enabled(lcore_id) == 0)
 920                         continue;
 921                 qconf = &lcore_conf[lcore_id];
 922                 printf("\nInitializing rx queues on lcore %u ... ", lcore_id);
 923                 fflush(stdout);
 924                 /* Init RX queues */
 925                 for (queue = 0; queue < qconf->n_rx_queue; ++queue) {
 926                         struct rte_eth_rxconf rxq_conf;
 927
 928                         portid = qconf->rx_queue_list[queue].port_id;
 929                         queueid = qconf->rx_queue_list[queue].queue_id;
 930
 931                         if (numa_on)
 932                                 socketid = (uint8_t)rte_lcore_to_socket_id(
 933                                         lcore_id);
 934                         else
 935                                 socketid = 0;
 936
 937                         printf("rxq=%d,%d,%d ", portid, queueid, socketid);
 938                         fflush(stdout);
 939
 940                         rte_eth_dev_info_get(portid, &dev_info);
 941                         rxq_conf = dev_info.default_rxconf;
 942                         rxq_conf.offloads = port_conf.rxmode.offloads;
 943                         if (!per_port_pool)
 944                                 ret = rte_eth_rx_queue_setup(
 945                                         portid, queueid, nb_rxd, socketid,
 946                                         &rxq_conf, pktmbuf_pool[0][socketid]);
 947                         else
 948                                 ret = rte_eth_rx_queue_setup(
 949                                         portid, queueid, nb_rxd, socketid,
 950                                         &rxq_conf,
 951                                         pktmbuf_pool[portid][socketid]);
 952                         if (ret < 0)
 953                                 rte_exit(EXIT_FAILURE,
 954                                          "rte_eth_rx_queue_setup: err=%d, "
 955                                          "port=%d\n",
 956                                          ret, portid);
 957
 958                         /* Add this queue node to its graph */
 959                         snprintf(qconf->rx_queue_list[queue].node_name,
 960                                  RTE_NODE_NAMESIZE, "ethdev_rx-%u-%u", portid,
 961                                  queueid);
 962                 }
 963
 964                 /* Alloc a graph to this lcore only if source exists  */
 965                 if (qconf->n_rx_queue)
 966                         nb_graphs++;
 967         }
 968
 969         printf("\n");
 970
 971         /* Ethdev node config, skip rx queue mapping */
 972         ret = rte_node_eth_config(ethdev_conf, nb_conf, nb_graphs);
 973         if (ret)
 974                 rte_exit(EXIT_FAILURE, "rte_node_eth_config: err=%d\n", ret);
 975
 976         /* Start ports */
 977         RTE_ETH_FOREACH_DEV(portid)
 978         {
 979                 if ((enabled_port_mask & (1 << portid)) == 0)
 980                         continue;
 981
 982                 /* Start device */
 983                 ret = rte_eth_dev_start(portid);
 984                 if (ret < 0)
 985                         rte_exit(EXIT_FAILURE,
 986                                  "rte_eth_dev_start: err=%d, port=%d\n", ret,
 987                                  portid);
 988
 989                 /*
 990                  * If enabled, put device in promiscuous mode.
 991                  * This allows IO forwarding mode to forward packets
 992                  * to itself through 2 cross-connected  ports of the
 993                  * target machine.
 994                  */
 995                 if (promiscuous_on)
 996                         rte_eth_promiscuous_enable(portid);
 997         }
 998
 999         printf("\n");
1000
1001         check_all_ports_link_status(enabled_port_mask);
1002
1003         /* Graph Initialization */
1004         nb_patterns = RTE_DIM(default_patterns);
1005         node_patterns = malloc((MAX_RX_QUEUE_PER_LCORE + nb_patterns) *
1006                                sizeof(*node_patterns));
1007         if (!node_patterns)
1008                 return -ENOMEM;
1009         memcpy(node_patterns, default_patterns,
1010                nb_patterns * sizeof(*node_patterns));
1011
1012         memset(&graph_conf, 0, sizeof(graph_conf));
1013         graph_conf.node_patterns = node_patterns;
1014
1015         for (lcore_id = 0; lcore_id < RTE_MAX_LCORE; lcore_id++) {
1016                 rte_graph_t graph_id;
1017                 rte_edge_t i;
1018
1019                 if (rte_lcore_is_enabled(lcore_id) == 0)
1020                         continue;
1021
1022                 qconf = &lcore_conf[lcore_id];
1023
1024                 /* Skip graph creation if no source exists */
1025                 if (!qconf->n_rx_queue)
1026                         continue;
1027
1028                 /* Add rx node patterns of this lcore */
1029                 for (i = 0; i < qconf->n_rx_queue; i++) {
1030                         graph_conf.node_patterns[nb_patterns + i] =
1031                                 qconf->rx_queue_list[i].node_name;
1032                 }
1033
1034                 graph_conf.nb_node_patterns = nb_patterns + i;
1035                 graph_conf.socket_id = rte_lcore_to_socket_id(lcore_id);
1036
1037                 snprintf(qconf->name, sizeof(qconf->name), "worker_%u",
1038                          lcore_id);
1039
1040                 graph_id = rte_graph_create(qconf->name, &graph_conf);
1041                 if (graph_id == RTE_GRAPH_ID_INVALID)
1042                         rte_exit(EXIT_FAILURE,
1043                                  "rte_graph_create(): graph_id invalid"
1044                                  " for lcore %u\n", lcore_id);
1045
1046                 qconf->graph_id = graph_id;
1047                 qconf->graph = rte_graph_lookup(qconf->name);
1048                 if (!qconf->graph)
1049                         rte_exit(EXIT_FAILURE,
1050                                  "rte_graph_lookup(): graph %s not found\n",
1051                                  qconf->name);
1052         }
1053
1054         memset(&rewrite_data, 0, sizeof(rewrite_data));
1055         rewrite_len = sizeof(rewrite_data);
1056
1057         /* Add route to ip4 graph infra */
1058         for (i = 0; i < IPV4_L3FWD_LPM_NUM_ROUTES; i++) {
1059                 char route_str[INET6_ADDRSTRLEN * 4];
1060                 char abuf[INET6_ADDRSTRLEN];
1061                 struct in_addr in;
1062                 uint32_t dst_port;
1063
1064                 /* Skip unused ports */
1065                 if ((1 << ipv4_l3fwd_lpm_route_array[i].if_out &
1066                      enabled_port_mask) == 0)
1067                         continue;
1068
1069                 dst_port = ipv4_l3fwd_lpm_route_array[i].if_out;
1070
1071                 in.s_addr = htonl(ipv4_l3fwd_lpm_route_array[i].ip);
1072                 snprintf(route_str, sizeof(route_str), "%s / %d (%d)",
1073                          inet_ntop(AF_INET, &in, abuf, sizeof(abuf)),
1074                          ipv4_l3fwd_lpm_route_array[i].depth,
1075                          ipv4_l3fwd_lpm_route_array[i].if_out);
1076
1077                 /* Use route index 'i' as next hop id */
1078                 ret = rte_node_ip4_route_add(
1079                         ipv4_l3fwd_lpm_route_array[i].ip,
1080                         ipv4_l3fwd_lpm_route_array[i].depth, i,
1081                         RTE_NODE_IP4_LOOKUP_NEXT_REWRITE);
1082
1083                 if (ret < 0)
1084                         rte_exit(EXIT_FAILURE,
1085                                  "Unable to add ip4 route %s to graph\n",
1086                                  route_str);
1087
1088                 memcpy(rewrite_data, val_eth + dst_port, rewrite_len);
1089
1090                 /* Add next hop rewrite data for id 'i' */
1091                 ret = rte_node_ip4_rewrite_add(i, rewrite_data,
1092                                                rewrite_len, dst_port);
1093                 if (ret < 0)
1094                         rte_exit(EXIT_FAILURE,
1095                                  "Unable to add next hop %u for "
1096                                  "route %s\n", i, route_str);
1097
1098                 RTE_LOG(INFO, L3FWD_GRAPH, "Added route %s, next_hop %u\n",
1099                         route_str, i);
1100         }
1101
1102         /* Launch per-lcore init on every slave lcore */
1103         rte_eal_mp_remote_launch(graph_main_loop, NULL, SKIP_MASTER);
1104
1105         /* Accumulate and print stats on master until exit */
1106         if (rte_graph_has_stats_feature())
1107                 print_stats();
1108
1109         /* Wait for slave cores to exit */
1110         ret = 0;
1111         RTE_LCORE_FOREACH_SLAVE(lcore_id) {
1112                 ret = rte_eal_wait_lcore(lcore_id);
1113                 /* Destroy graph */
1114                 if (ret < 0 || rte_graph_destroy(
1115                         rte_graph_from_name(lcore_conf[lcore_id].name))) {
1116                         ret = -1;
1117                         break;
1118                 }
1119         }
1120         free(node_patterns);
1121
1122         /* Stop ports */
1123         RTE_ETH_FOREACH_DEV(portid) {
1124                 if ((enabled_port_mask & (1 << portid)) == 0)
1125                         continue;
1126                 printf("Closing port %d...", portid);
1127                 rte_eth_dev_stop(portid);
1128                 rte_eth_dev_close(portid);
1129                 printf(" Done\n");
1130         }
1131         printf("Bye...\n");
1132
1133         return ret;
1134 }