85dbd7ec745255f6b7b8e469091777a372ad6f7e
[dpdk.git] / examples / exception_path / main.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2010-2014 Intel Corporation
3  */
4
5 #include <stdio.h>
6 #include <stdlib.h>
7 #include <stdint.h>
8 #include <inttypes.h>
9 #include <string.h>
10 #include <sys/queue.h>
11 #include <stdarg.h>
12 #include <errno.h>
13 #include <getopt.h>
14
15 #include <netinet/in.h>
16 #include <net/if.h>
17 #ifdef RTE_EXEC_ENV_LINUX
18 #include <linux/if_tun.h>
19 #endif
20 #include <fcntl.h>
21 #include <sys/ioctl.h>
22 #include <unistd.h>
23 #include <signal.h>
24
25 #include <rte_common.h>
26 #include <rte_log.h>
27 #include <rte_memory.h>
28 #include <rte_memcpy.h>
29 #include <rte_eal.h>
30 #include <rte_per_lcore.h>
31 #include <rte_launch.h>
32 #include <rte_atomic.h>
33 #include <rte_lcore.h>
34 #include <rte_branch_prediction.h>
35 #include <rte_interrupts.h>
36 #include <rte_debug.h>
37 #include <rte_ether.h>
38 #include <rte_ethdev.h>
39 #include <rte_mempool.h>
40 #include <rte_mbuf.h>
41 #include <rte_string_fns.h>
42 #include <rte_cycles.h>
43
44 #ifndef APP_MAX_LCORE
45 #if (RTE_MAX_LCORE > 64)
46 #define APP_MAX_LCORE 64
47 #else
48 #define APP_MAX_LCORE RTE_MAX_LCORE
49 #endif
50 #endif
51
52 /* Macros for printing using RTE_LOG */
53 #define RTE_LOGTYPE_APP RTE_LOGTYPE_USER1
54 #define FATAL_ERROR(fmt, args...)       rte_exit(EXIT_FAILURE, fmt "\n", ##args)
55 #define PRINT_INFO(fmt, args...)        RTE_LOG(INFO, APP, fmt "\n", ##args)
56
57 /* Max ports than can be used (each port is associated with two lcores) */
58 #define MAX_PORTS               (APP_MAX_LCORE / 2)
59
60 /* Max size of a single packet */
61 #define MAX_PACKET_SZ (2048)
62
63 /* Size of the data buffer in each mbuf */
64 #define MBUF_DATA_SZ (MAX_PACKET_SZ + RTE_PKTMBUF_HEADROOM)
65
66 /* Number of mbufs in mempool that is created */
67 #define NB_MBUF                 8192
68
69 /* How many packets to attempt to read from NIC in one go */
70 #define PKT_BURST_SZ            32
71
72 /* How many objects (mbufs) to keep in per-lcore mempool cache */
73 #define MEMPOOL_CACHE_SZ        PKT_BURST_SZ
74
75 /* Number of RX ring descriptors */
76 #define NB_RXD                  1024
77
78 /* Number of TX ring descriptors */
79 #define NB_TXD                  1024
80
81 /*
82  * RX and TX Prefetch, Host, and Write-back threshold values should be
83  * carefully set for optimal performance. Consult the network
84  * controller's datasheet and supporting DPDK documentation for guidance
85  * on how these parameters should be set.
86  */
87
88 /* Options for configuring ethernet port */
89 static struct rte_eth_conf port_conf = {
90         .txmode = {
91                 .mq_mode = ETH_MQ_TX_NONE,
92         },
93 };
94
95 /* Mempool for mbufs */
96 static struct rte_mempool * pktmbuf_pool = NULL;
97
98 /* Mask of enabled ports */
99 static uint32_t ports_mask = 0;
100
101 /* Mask of cores that read from NIC and write to tap */
102 static uint64_t input_cores_mask = 0;
103
104 /* Mask of cores that read from tap and write to NIC */
105 static uint64_t output_cores_mask = 0;
106
107 /* Array storing port_id that is associated with each lcore */
108 static uint16_t port_ids[APP_MAX_LCORE];
109
110 /* Structure type for recording lcore-specific stats */
111 struct stats {
112         uint64_t rx;
113         uint64_t tx;
114         uint64_t dropped;
115 } __rte_cache_aligned;
116
117 /* Array of lcore-specific stats */
118 static struct stats lcore_stats[APP_MAX_LCORE];
119
120 /* Print out statistics on packets handled */
121 static void
122 print_stats(void)
123 {
124         unsigned i;
125
126         printf("\n**Exception-Path example application statistics**\n"
127                "=======  ======  ============  ============  ===============\n"
128                " Lcore    Port            RX            TX    Dropped on TX\n"
129                "-------  ------  ------------  ------------  ---------------\n");
130         RTE_LCORE_FOREACH(i) {
131                 /* limit ourselves to application supported cores only */
132                 if (i >= APP_MAX_LCORE)
133                         break;
134                 printf("%6u %7u %13"PRIu64" %13"PRIu64" %16"PRIu64"\n",
135                        i, (unsigned)port_ids[i],
136                        lcore_stats[i].rx, lcore_stats[i].tx,
137                        lcore_stats[i].dropped);
138         }
139         printf("=======  ======  ============  ============  ===============\n");
140 }
141
142 /* Custom handling of signals to handle stats */
143 static void
144 signal_handler(int signum)
145 {
146         /* When we receive a USR1 signal, print stats */
147         if (signum == SIGUSR1) {
148                 print_stats();
149         }
150
151         /* When we receive a USR2 signal, reset stats */
152         if (signum == SIGUSR2) {
153                 memset(&lcore_stats, 0, sizeof(lcore_stats));
154                 printf("\n**Statistics have been reset**\n");
155                 return;
156         }
157 }
158
159 #ifdef RTE_EXEC_ENV_LINUX
160 /*
161  * Create a tap network interface, or use existing one with same name.
162  * If name[0]='\0' then a name is automatically assigned and returned in name.
163  */
164 static int tap_create(char *name)
165 {
166         struct ifreq ifr;
167         int fd, ret;
168
169         fd = open("/dev/net/tun", O_RDWR);
170         if (fd < 0)
171                 return fd;
172
173         memset(&ifr, 0, sizeof(ifr));
174
175         /* TAP device without packet information */
176         ifr.ifr_flags = IFF_TAP | IFF_NO_PI;
177
178         if (name && *name)
179                 strlcpy(ifr.ifr_name, name, IFNAMSIZ);
180
181         ret = ioctl(fd, TUNSETIFF, (void *) &ifr);
182         if (ret < 0) {
183                 close(fd);
184                 return ret;
185         }
186
187         if (name)
188                 strlcpy(name, ifr.ifr_name, IFNAMSIZ);
189
190         return fd;
191 }
192 #else
193 /*
194  * Find a free tap network interface, or create a new one.
195  * The name is automatically assigned and returned in name.
196  */
197 static int tap_create(char *name)
198 {
199         int i, fd = -1;
200         char devname[PATH_MAX];
201
202         for (i = 0; i < 255; i++) {
203                 snprintf(devname, sizeof(devname), "/dev/tap%d", i);
204                 fd = open(devname, O_RDWR);
205                 if (fd >= 0 || errno != EBUSY)
206                         break;
207         }
208
209         if (name)
210                 snprintf(name, IFNAMSIZ, "tap%d", i);
211
212         return fd;
213 }
214 #endif
215
216 /* Main processing loop */
217 static int
218 main_loop(__attribute__((unused)) void *arg)
219 {
220         const unsigned lcore_id = rte_lcore_id();
221         char tap_name[IFNAMSIZ];
222         int tap_fd;
223
224         if ((1ULL << lcore_id) & input_cores_mask) {
225                 /* Create new tap interface */
226                 snprintf(tap_name, IFNAMSIZ, "tap_dpdk_%.2u", lcore_id);
227                 tap_fd = tap_create(tap_name);
228                 if (tap_fd < 0)
229                         FATAL_ERROR("Could not create tap interface \"%s\" (%d)",
230                                         tap_name, tap_fd);
231
232                 PRINT_INFO("Lcore %u is reading from port %u and writing to %s",
233                            lcore_id, (unsigned)port_ids[lcore_id], tap_name);
234                 fflush(stdout);
235                 /* Loop forever reading from NIC and writing to tap */
236                 for (;;) {
237                         struct rte_mbuf *pkts_burst[PKT_BURST_SZ];
238                         unsigned i;
239                         const unsigned nb_rx =
240                                         rte_eth_rx_burst(port_ids[lcore_id], 0,
241                                             pkts_burst, PKT_BURST_SZ);
242                         lcore_stats[lcore_id].rx += nb_rx;
243                         for (i = 0; likely(i < nb_rx); i++) {
244                                 struct rte_mbuf *m = pkts_burst[i];
245                                 /* Ignore return val from write() */
246                                 int ret = write(tap_fd,
247                                                 rte_pktmbuf_mtod(m, void*),
248                                                 rte_pktmbuf_data_len(m));
249                                 rte_pktmbuf_free(m);
250                                 if (unlikely(ret < 0))
251                                         lcore_stats[lcore_id].dropped++;
252                                 else
253                                         lcore_stats[lcore_id].tx++;
254                         }
255                 }
256         }
257         else if ((1ULL << lcore_id) & output_cores_mask) {
258                 /* Create new tap interface */
259                 snprintf(tap_name, IFNAMSIZ, "tap_dpdk_%.2u", lcore_id);
260                 tap_fd = tap_create(tap_name);
261                 if (tap_fd < 0)
262                         FATAL_ERROR("Could not create tap interface \"%s\" (%d)",
263                                         tap_name, tap_fd);
264
265                 PRINT_INFO("Lcore %u is reading from %s and writing to port %u",
266                            lcore_id, tap_name, (unsigned)port_ids[lcore_id]);
267                 fflush(stdout);
268                 /* Loop forever reading from tap and writing to NIC */
269                 for (;;) {
270                         int ret;
271                         struct rte_mbuf *m = rte_pktmbuf_alloc(pktmbuf_pool);
272                         if (m == NULL)
273                                 continue;
274
275                         ret = read(tap_fd, rte_pktmbuf_mtod(m, void *),
276                                 MAX_PACKET_SZ);
277                         lcore_stats[lcore_id].rx++;
278                         if (unlikely(ret < 0)) {
279                                 FATAL_ERROR("Reading from %s interface failed",
280                                             tap_name);
281                         }
282                         m->nb_segs = 1;
283                         m->next = NULL;
284                         m->pkt_len = (uint16_t)ret;
285                         m->data_len = (uint16_t)ret;
286                         ret = rte_eth_tx_burst(port_ids[lcore_id], 0, &m, 1);
287                         if (unlikely(ret < 1)) {
288                                 rte_pktmbuf_free(m);
289                                 lcore_stats[lcore_id].dropped++;
290                         }
291                         else {
292                                 lcore_stats[lcore_id].tx++;
293                         }
294                 }
295         }
296         else {
297                 PRINT_INFO("Lcore %u has nothing to do", lcore_id);
298                 return 0;
299         }
300         /*
301          * Tap file is closed automatically when program exits. Putting close()
302          * here will cause the compiler to give an error about unreachable code.
303          */
304 }
305
306 /* Display usage instructions */
307 static void
308 print_usage(const char *prgname)
309 {
310         PRINT_INFO("\nUsage: %s [EAL options] -- -p PORTMASK -i IN_CORES -o OUT_CORES\n"
311                    "    -p PORTMASK: hex bitmask of ports to use\n"
312                    "    -i IN_CORES: hex bitmask of cores which read from NIC\n"
313                    "    -o OUT_CORES: hex bitmask of cores which write to NIC",
314                    prgname);
315 }
316
317 /* Convert string to unsigned number. 0 is returned if error occurs */
318 static uint64_t
319 parse_unsigned(const char *portmask)
320 {
321         char *end = NULL;
322         uint64_t num;
323
324         num = strtoull(portmask, &end, 16);
325         if ((portmask[0] == '\0') || (end == NULL) || (*end != '\0'))
326                 return 0;
327
328         return (uint64_t)num;
329 }
330
331 /* Record affinities between ports and lcores in global port_ids[] array */
332 static void
333 setup_port_lcore_affinities(void)
334 {
335         unsigned long i;
336         uint16_t tx_port = 0;
337         uint16_t rx_port = 0;
338
339         /* Setup port_ids[] array, and check masks were ok */
340         for (i = 0; i < APP_MAX_LCORE; i++) {
341                 if (!rte_lcore_is_enabled(i))
342                         continue;
343                 if (input_cores_mask & (1ULL << i)) {
344                         /* Skip ports that are not enabled */
345                         while ((ports_mask & (1 << rx_port)) == 0) {
346                                 rx_port++;
347                                 if (rx_port > (sizeof(ports_mask) * 8))
348                                         goto fail; /* not enough ports */
349                         }
350
351                         port_ids[i] = rx_port++;
352                 } else if (output_cores_mask & (1ULL << (i & 0x3f))) {
353                         /* Skip ports that are not enabled */
354                         while ((ports_mask & (1 << tx_port)) == 0) {
355                                 tx_port++;
356                                 if (tx_port > (sizeof(ports_mask) * 8))
357                                         goto fail; /* not enough ports */
358                         }
359
360                         port_ids[i] = tx_port++;
361                 }
362         }
363
364         if (rx_port != tx_port)
365                 goto fail; /* uneven number of cores in masks */
366
367         if (ports_mask & (~((1 << rx_port) - 1)))
368                 goto fail; /* unused ports */
369
370         return;
371 fail:
372         FATAL_ERROR("Invalid core/port masks specified on command line");
373 }
374
375 /* Parse the arguments given in the command line of the application */
376 static void
377 parse_args(int argc, char **argv)
378 {
379         int opt;
380         const char *prgname = argv[0];
381
382         /* Disable printing messages within getopt() */
383         opterr = 0;
384
385         /* Parse command line */
386         while ((opt = getopt(argc, argv, "i:o:p:")) != EOF) {
387                 switch (opt) {
388                 case 'i':
389                         input_cores_mask = parse_unsigned(optarg);
390                         break;
391                 case 'o':
392                         output_cores_mask = parse_unsigned(optarg);
393                         break;
394                 case 'p':
395                         ports_mask = parse_unsigned(optarg);
396                         break;
397                 default:
398                         print_usage(prgname);
399                         FATAL_ERROR("Invalid option specified");
400                 }
401         }
402
403         /* Check that options were parsed ok */
404         if (input_cores_mask == 0) {
405                 print_usage(prgname);
406                 FATAL_ERROR("IN_CORES not specified correctly");
407         }
408         if (output_cores_mask == 0) {
409                 print_usage(prgname);
410                 FATAL_ERROR("OUT_CORES not specified correctly");
411         }
412         if (ports_mask == 0) {
413                 print_usage(prgname);
414                 FATAL_ERROR("PORTMASK not specified correctly");
415         }
416
417         setup_port_lcore_affinities();
418 }
419
420 /* Initialise a single port on an Ethernet device */
421 static void
422 init_port(uint16_t port)
423 {
424         int ret;
425         uint16_t nb_rxd = NB_RXD;
426         uint16_t nb_txd = NB_TXD;
427         struct rte_eth_dev_info dev_info;
428         struct rte_eth_rxconf rxq_conf;
429         struct rte_eth_txconf txq_conf;
430         struct rte_eth_conf local_port_conf = port_conf;
431
432         /* Initialise device and RX/TX queues */
433         PRINT_INFO("Initialising port %u ...", port);
434         fflush(stdout);
435
436         ret = rte_eth_dev_info_get(port, &dev_info);
437         if (ret != 0)
438                 FATAL_ERROR("Error during getting device (port %u) info: %s\n",
439                         port, strerror(-ret));
440
441         if (dev_info.tx_offload_capa & DEV_TX_OFFLOAD_MBUF_FAST_FREE)
442                 local_port_conf.txmode.offloads |=
443                         DEV_TX_OFFLOAD_MBUF_FAST_FREE;
444         ret = rte_eth_dev_configure(port, 1, 1, &local_port_conf);
445         if (ret < 0)
446                 FATAL_ERROR("Could not configure port%u (%d)", port, ret);
447
448         ret = rte_eth_dev_adjust_nb_rx_tx_desc(port, &nb_rxd, &nb_txd);
449         if (ret < 0)
450                 FATAL_ERROR("Could not adjust number of descriptors for port%u (%d)",
451                             port, ret);
452
453         rxq_conf = dev_info.default_rxconf;
454         rxq_conf.offloads = local_port_conf.rxmode.offloads;
455         ret = rte_eth_rx_queue_setup(port, 0, nb_rxd,
456                                 rte_eth_dev_socket_id(port),
457                                 &rxq_conf,
458                                 pktmbuf_pool);
459         if (ret < 0)
460                 FATAL_ERROR("Could not setup up RX queue for port%u (%d)",
461                                 port, ret);
462
463         txq_conf = dev_info.default_txconf;
464         txq_conf.offloads = local_port_conf.txmode.offloads;
465         ret = rte_eth_tx_queue_setup(port, 0, nb_txd,
466                                 rte_eth_dev_socket_id(port),
467                                 &txq_conf);
468         if (ret < 0)
469                 FATAL_ERROR("Could not setup up TX queue for port%u (%d)",
470                                 port, ret);
471
472         ret = rte_eth_dev_start(port);
473         if (ret < 0)
474                 FATAL_ERROR("Could not start port%u (%d)", port, ret);
475
476         ret = rte_eth_promiscuous_enable(port);
477         if (ret != 0)
478                 FATAL_ERROR("Could not enable promiscuous mode for port%u (%s)",
479                             port, rte_strerror(-ret));
480 }
481
482 /* Check the link status of all ports in up to 9s, and print them finally */
483 static void
484 check_all_ports_link_status(uint32_t port_mask)
485 {
486 #define CHECK_INTERVAL 100 /* 100ms */
487 #define MAX_CHECK_TIME 90 /* 9s (90 * 100ms) in total */
488         uint16_t portid;
489         uint8_t count, all_ports_up, print_flag = 0;
490         struct rte_eth_link link;
491         int ret;
492
493         printf("\nChecking link status");
494         fflush(stdout);
495         for (count = 0; count <= MAX_CHECK_TIME; count++) {
496                 all_ports_up = 1;
497                 RTE_ETH_FOREACH_DEV(portid) {
498                         if ((port_mask & (1 << portid)) == 0)
499                                 continue;
500                         memset(&link, 0, sizeof(link));
501                         ret = rte_eth_link_get_nowait(portid, &link);
502                         if (ret < 0) {
503                                 all_ports_up = 0;
504                                 if (print_flag == 1)
505                                         printf("Port %u link get failed: %s\n",
506                                                 portid, rte_strerror(-ret));
507                                 continue;
508                         }
509                         /* print link status if flag set */
510                         if (print_flag == 1) {
511                                 if (link.link_status)
512                                         printf(
513                                         "Port%d Link Up. Speed %u Mbps - %s\n",
514                                                 portid, link.link_speed,
515                                 (link.link_duplex == ETH_LINK_FULL_DUPLEX) ?
516                                         ("full-duplex") : ("half-duplex\n"));
517                                 else
518                                         printf("Port %d Link Down\n", portid);
519                                 continue;
520                         }
521                         /* clear all_ports_up flag if any link down */
522                         if (link.link_status == ETH_LINK_DOWN) {
523                                 all_ports_up = 0;
524                                 break;
525                         }
526                 }
527                 /* after finally printing all link status, get out */
528                 if (print_flag == 1)
529                         break;
530
531                 if (all_ports_up == 0) {
532                         printf(".");
533                         fflush(stdout);
534                         rte_delay_ms(CHECK_INTERVAL);
535                 }
536
537                 /* set the print_flag if all ports up or timeout */
538                 if (all_ports_up == 1 || count == (MAX_CHECK_TIME - 1)) {
539                         print_flag = 1;
540                         printf("done\n");
541                 }
542         }
543 }
544
545 /* Initialise ports/queues etc. and start main loop on each core */
546 int
547 main(int argc, char** argv)
548 {
549         int ret;
550         unsigned i,high_port;
551         uint16_t nb_sys_ports, port;
552
553         /* Associate signal_hanlder function with USR signals */
554         signal(SIGUSR1, signal_handler);
555         signal(SIGUSR2, signal_handler);
556
557         /* Initialise EAL */
558         ret = rte_eal_init(argc, argv);
559         if (ret < 0)
560                 FATAL_ERROR("Could not initialise EAL (%d)", ret);
561         argc -= ret;
562         argv += ret;
563
564         /* Parse application arguments (after the EAL ones) */
565         parse_args(argc, argv);
566
567         /* Create the mbuf pool */
568         pktmbuf_pool = rte_pktmbuf_pool_create("mbuf_pool", NB_MBUF,
569                         MEMPOOL_CACHE_SZ, 0, MBUF_DATA_SZ, rte_socket_id());
570         if (pktmbuf_pool == NULL) {
571                 FATAL_ERROR("Could not initialise mbuf pool");
572                 return -1;
573         }
574
575         /* Get number of ports found in scan */
576         nb_sys_ports = rte_eth_dev_count_avail();
577         if (nb_sys_ports == 0)
578                 FATAL_ERROR("No supported Ethernet device found");
579         /* Find highest port set in portmask */
580         for (high_port = (sizeof(ports_mask) * 8) - 1;
581                         (high_port != 0) && !(ports_mask & (1 << high_port));
582                         high_port--)
583                 ; /* empty body */
584         if (high_port > nb_sys_ports)
585                 FATAL_ERROR("Port mask requires more ports than available");
586
587         /* Initialise each port */
588         RTE_ETH_FOREACH_DEV(port) {
589                 /* Skip ports that are not enabled */
590                 if ((ports_mask & (1 << port)) == 0) {
591                         continue;
592                 }
593                 init_port(port);
594         }
595         check_all_ports_link_status(ports_mask);
596
597         /* Launch per-lcore function on every lcore */
598         rte_eal_mp_remote_launch(main_loop, NULL, CALL_MASTER);
599         RTE_LCORE_FOREACH_SLAVE(i) {
600                 if (rte_eal_wait_lcore(i) < 0)
601                         return -1;
602         }
603
604         return 0;
605 }