1 /* SPDX-License-Identifier: BSD-3-Clause
2 * Copyright(c) 2010-2016 Intel Corporation
12 #include <sys/types.h>
13 #include <sys/queue.h>
14 #include <netinet/in.h>
21 #include <rte_common.h>
23 #include <rte_memory.h>
24 #include <rte_memcpy.h>
26 #include <rte_launch.h>
27 #include <rte_atomic.h>
28 #include <rte_spinlock.h>
29 #include <rte_cycles.h>
30 #include <rte_prefetch.h>
31 #include <rte_lcore.h>
32 #include <rte_per_lcore.h>
33 #include <rte_branch_prediction.h>
34 #include <rte_interrupts.h>
35 #include <rte_random.h>
36 #include <rte_debug.h>
37 #include <rte_ether.h>
38 #include <rte_ethdev.h>
40 #include <rte_mempool.h>
42 #include <rte_malloc.h>
46 #define RTE_LOGTYPE_L2FWD RTE_LOGTYPE_USER1
47 #define MBUF_NAME "mbuf_pool_%d"
48 #define MBUF_DATA_SIZE RTE_MBUF_DEFAULT_BUF_SIZE
50 #define RING_MASTER_NAME "l2fwd_ring_m2s_"
51 #define RING_SLAVE_NAME "l2fwd_ring_s2m_"
52 #define MAX_NAME_LEN 32
53 /* RECREATE flag indicate needs initialize resource and launch slave_core again */
54 #define SLAVE_RECREATE_FLAG 0x1
55 /* RESTART flag indicate needs restart port and send START command again */
56 #define SLAVE_RESTART_FLAG 0x2
57 #define INVALID_MAPPING_ID ((unsigned)LCORE_ID_ANY)
58 /* Maximum message buffer per slave */
59 #define NB_CORE_MSGBUF 32
65 #define MAX_PKT_BURST 32
66 #define BURST_TX_DRAIN_US 100 /* TX drain every ~100us */
69 * Configurable number of RX/TX ring descriptors
71 #define RTE_TEST_RX_DESC_DEFAULT 1024
72 #define RTE_TEST_TX_DESC_DEFAULT 1024
73 static uint16_t nb_rxd = RTE_TEST_RX_DESC_DEFAULT;
74 static uint16_t nb_txd = RTE_TEST_TX_DESC_DEFAULT;
76 /* ethernet addresses of ports */
77 static struct ether_addr l2fwd_ports_eth_addr[RTE_MAX_ETHPORTS];
79 /* mask of enabled ports */
80 static uint32_t l2fwd_enabled_port_mask = 0;
82 /* list of enabled ports */
83 static uint32_t l2fwd_dst_ports[RTE_MAX_ETHPORTS];
85 static unsigned int l2fwd_rx_queue_per_lcore = 1;
89 struct rte_mbuf *m_table[MAX_PKT_BURST];
92 #define MAX_RX_QUEUE_PER_LCORE 16
93 #define MAX_TX_QUEUE_PER_PORT 16
94 struct lcore_queue_conf {
96 unsigned rx_port_list[MAX_RX_QUEUE_PER_LCORE];
97 } __rte_cache_aligned;
98 struct lcore_queue_conf lcore_queue_conf[RTE_MAX_LCORE];
100 struct rte_eth_dev_tx_buffer *tx_buffer[RTE_MAX_ETHPORTS];
102 struct lcore_resource_struct {
103 int enabled; /* Only set in case this lcore involved into packet forwarding */
104 int flags; /* Set only slave need to restart or recreate */
105 unsigned lcore_id; /* lcore ID */
106 unsigned pair_id; /* dependency lcore ID on port */
107 char ring_name[2][MAX_NAME_LEN];
108 /* ring[0] for master send cmd, slave read */
109 /* ring[1] for slave send ack, master read */
110 struct rte_ring *ring[2];
111 int port_num; /* Total port numbers */
112 /* Port id for that lcore to receive packets */
113 uint16_t port[RTE_MAX_ETHPORTS];
114 }__attribute__((packed)) __rte_cache_aligned;
116 static struct lcore_resource_struct lcore_resource[RTE_MAX_LCORE];
117 static struct rte_mempool *message_pool;
118 static rte_spinlock_t res_lock = RTE_SPINLOCK_INITIALIZER;
119 /* use floating processes */
120 static int float_proc = 0;
121 /* Save original cpu affinity */
127 static const struct rte_eth_conf port_conf = {
130 .ignore_offload_bitfield = 1,
131 .offloads = DEV_RX_OFFLOAD_CRC_STRIP,
134 .mq_mode = ETH_MQ_TX_NONE,
138 static struct rte_mempool * l2fwd_pktmbuf_pool[RTE_MAX_ETHPORTS];
140 /* Per-port statistics struct */
141 struct l2fwd_port_statistics {
145 } __rte_cache_aligned;
146 struct l2fwd_port_statistics *port_statistics;
148 * pointer to lcore ID mapping array, used to return lcore id in case slave
149 * process exited unexpectedly, use only floating process option applied
151 unsigned *mapping_id;
153 /* A tsc-based timer responsible for triggering statistics printout */
154 #define TIMER_MILLISECOND 2000000ULL /* around 1ms at 2 Ghz */
155 #define MAX_TIMER_PERIOD 86400 /* 1 day max */
156 static int64_t timer_period = 10 * TIMER_MILLISECOND * 1000; /* default period is 10 seconds */
158 static int l2fwd_launch_one_lcore(void *dummy);
160 /* Print out statistics on packets dropped */
164 uint64_t total_packets_dropped, total_packets_tx, total_packets_rx;
167 total_packets_dropped = 0;
168 total_packets_tx = 0;
169 total_packets_rx = 0;
171 const char clr[] = { 27, '[', '2', 'J', '\0' };
172 const char topLeft[] = { 27, '[', '1', ';', '1', 'H','\0' };
174 /* Clear screen and move to top left */
175 printf("%s%s", clr, topLeft);
177 printf("\nPort statistics ====================================");
179 for (portid = 0; portid < RTE_MAX_ETHPORTS; portid++) {
180 /* skip disabled ports */
181 if ((l2fwd_enabled_port_mask & (1 << portid)) == 0)
183 printf("\nStatistics for port %u ------------------------------"
184 "\nPackets sent: %24"PRIu64
185 "\nPackets received: %20"PRIu64
186 "\nPackets dropped: %21"PRIu64,
188 port_statistics[portid].tx,
189 port_statistics[portid].rx,
190 port_statistics[portid].dropped);
192 total_packets_dropped += port_statistics[portid].dropped;
193 total_packets_tx += port_statistics[portid].tx;
194 total_packets_rx += port_statistics[portid].rx;
196 printf("\nAggregate statistics ==============================="
197 "\nTotal packets sent: %18"PRIu64
198 "\nTotal packets received: %14"PRIu64
199 "\nTotal packets dropped: %15"PRIu64,
202 total_packets_dropped);
203 printf("\n====================================================\n");
207 clear_cpu_affinity(void)
211 s = sched_setaffinity(0, cpu_aff.size, &cpu_aff.set);
213 printf("sched_setaffinity failed:%s\n", strerror(errno));
221 get_cpu_affinity(void)
225 cpu_aff.size = sizeof(cpu_set_t);
226 CPU_ZERO(&cpu_aff.set);
228 s = sched_getaffinity(0, cpu_aff.size, &cpu_aff.set);
230 printf("sched_getaffinity failed:%s\n", strerror(errno));
238 * This fnciton demonstrates the approach to create ring in first instance
239 * or re-attach an existed ring in later instance.
241 static struct rte_ring *
242 create_ring(const char *name, unsigned count,
243 int socket_id,unsigned flags)
245 struct rte_ring *ring;
250 /* If already create, just attached it */
251 if (likely((ring = rte_ring_lookup(name)) != NULL))
254 /* First call it, create one */
255 return rte_ring_create(name, count, socket_id, flags);
258 /* Malloc with rte_malloc on structures that shared by master and slave */
260 l2fwd_malloc_shared_struct(void)
262 port_statistics = rte_zmalloc("port_stat",
263 sizeof(struct l2fwd_port_statistics) * RTE_MAX_ETHPORTS,
265 if (port_statistics == NULL)
268 /* allocate mapping_id array */
271 mapping_id = rte_malloc("mapping_id", sizeof(unsigned) * RTE_MAX_LCORE,
274 if (mapping_id == NULL)
277 for (i = 0 ;i < RTE_MAX_LCORE; i++)
278 mapping_id[i] = INVALID_MAPPING_ID;
283 /* Create ring which used for communicate among master and slave */
285 create_ms_ring(unsigned slaveid)
287 unsigned flag = RING_F_SP_ENQ | RING_F_SC_DEQ;
288 struct lcore_resource_struct *res = &lcore_resource[slaveid];
289 unsigned socketid = rte_socket_id();
291 /* Always assume create ring on master socket_id */
292 /* Default only create a ring size 32 */
293 snprintf(res->ring_name[0], MAX_NAME_LEN, "%s%u",
294 RING_MASTER_NAME, slaveid);
295 if ((res->ring[0] = create_ring(res->ring_name[0], NB_CORE_MSGBUF,
296 socketid, flag)) == NULL) {
297 printf("Create m2s ring %s failed\n", res->ring_name[0]);
301 snprintf(res->ring_name[1], MAX_NAME_LEN, "%s%u",
302 RING_SLAVE_NAME, slaveid);
303 if ((res->ring[1] = create_ring(res->ring_name[1], NB_CORE_MSGBUF,
304 socketid, flag)) == NULL) {
305 printf("Create s2m ring %s failed\n", res->ring_name[1]);
312 /* send command to pair in paired master and slave ring */
314 sendcmd(unsigned slaveid, enum l2fwd_cmd cmd, int is_master)
316 struct lcore_resource_struct *res = &lcore_resource[slaveid];
320 /* Only check master, it must be enabled and running if it is slave */
321 if (is_master && !res->enabled)
324 if (res->ring[fd] == NULL)
327 if (rte_mempool_get(message_pool, &msg) < 0) {
328 printf("Error to get message buffer\n");
332 *(enum l2fwd_cmd *)msg = cmd;
334 if (rte_ring_enqueue(res->ring[fd], msg) != 0) {
335 printf("Enqueue error\n");
336 rte_mempool_put(message_pool, msg);
343 /* Get command from pair in paired master and slave ring */
345 getcmd(unsigned slaveid, enum l2fwd_cmd *cmd, int is_master)
347 struct lcore_resource_struct *res = &lcore_resource[slaveid];
349 int fd = !!is_master;
351 /* Only check master, it must be enabled and running if it is slave */
352 if (is_master && (!res->enabled))
355 if (res->ring[fd] == NULL)
358 ret = rte_ring_dequeue(res->ring[fd], &msg);
361 *cmd = *(enum l2fwd_cmd *)msg;
362 rte_mempool_put(message_pool, msg);
367 /* Master send command to slave and wait until ack received or error met */
369 master_sendcmd_with_ack(unsigned slaveid, enum l2fwd_cmd cmd)
371 enum l2fwd_cmd ack_cmd;
374 if (sendcmd(slaveid, cmd, 1) != 0)
375 rte_exit(EXIT_FAILURE, "Failed to send message\n");
379 ret = getcmd(slaveid, &ack_cmd, 1);
380 if (ret == 0 && cmd == ack_cmd)
383 /* If slave not running yet, return an error */
384 if (flib_query_slave_status(slaveid) != ST_RUN) {
393 /* restart all port that assigned to that slave lcore */
395 reset_slave_all_ports(unsigned slaveid)
397 struct lcore_resource_struct *slave = &lcore_resource[slaveid];
400 /* stop/start port */
401 for (i = 0; i < slave->port_num; i++) {
402 char buf_name[RTE_MEMPOOL_NAMESIZE];
403 struct rte_mempool *pool;
404 printf("Stop port :%d\n", slave->port[i]);
405 rte_eth_dev_stop(slave->port[i]);
406 snprintf(buf_name, RTE_MEMPOOL_NAMESIZE, MBUF_NAME, slave->port[i]);
407 pool = rte_mempool_lookup(buf_name);
409 printf("Port %d mempool free object is %u(%u)\n", slave->port[i],
410 rte_mempool_avail_count(pool),
411 (unsigned int)NB_MBUF);
413 printf("Can't find mempool %s\n", buf_name);
415 printf("Start port :%d\n", slave->port[i]);
416 ret = rte_eth_dev_start(slave->port[i]);
424 reset_shared_structures(unsigned slaveid)
427 /* Only port are shared resource here */
428 ret = reset_slave_all_ports(slaveid);
434 * Call this function to re-create resource that needed for slave process that
435 * exited in last instance
438 init_slave_res(unsigned slaveid)
440 struct lcore_resource_struct *slave = &lcore_resource[slaveid];
443 if (!slave->enabled) {
444 printf("Something wrong with lcore=%u enabled=%d\n",slaveid,
449 /* Initialize ring */
450 if (create_ms_ring(slaveid) != 0)
451 rte_exit(EXIT_FAILURE, "failed to create ring for slave %u\n",
454 /* drain un-read buffer if have */
455 while (getcmd(slaveid, &cmd, 1) == 0);
456 while (getcmd(slaveid, &cmd, 0) == 0);
462 recreate_one_slave(unsigned slaveid)
465 /* Re-initialize resource for stalled slave */
466 if ((ret = init_slave_res(slaveid)) != 0) {
467 printf("Init slave=%u failed\n", slaveid);
471 if ((ret = flib_remote_launch(l2fwd_launch_one_lcore, NULL, slaveid))
473 printf("Launch slave %u failed\n", slaveid);
479 * remapping resource belong to slave_id to new lcore that gets from flib_assign_lcore_id(),
480 * used only floating process option applied.
483 * original lcore_id that apply for remapping
486 remapping_slave_resource(unsigned slaveid, unsigned map_id)
489 /* remapping lcore_resource */
490 memcpy(&lcore_resource[map_id], &lcore_resource[slaveid],
491 sizeof(struct lcore_resource_struct));
493 /* remapping lcore_queue_conf */
494 memcpy(&lcore_queue_conf[map_id], &lcore_queue_conf[slaveid],
495 sizeof(struct lcore_queue_conf));
499 reset_pair(unsigned slaveid, unsigned pairid)
502 if ((ret = reset_shared_structures(slaveid)) != 0)
505 if((ret = reset_shared_structures(pairid)) != 0)
509 unsigned map_id = mapping_id[slaveid];
511 if (map_id != INVALID_MAPPING_ID) {
512 printf("%u return mapping id %u\n", slaveid, map_id);
513 flib_free_lcore_id(map_id);
514 mapping_id[slaveid] = INVALID_MAPPING_ID;
517 map_id = mapping_id[pairid];
518 if (map_id != INVALID_MAPPING_ID) {
519 printf("%u return mapping id %u\n", pairid, map_id);
520 flib_free_lcore_id(map_id);
521 mapping_id[pairid] = INVALID_MAPPING_ID;
525 if((ret = recreate_one_slave(slaveid)) != 0)
528 ret = recreate_one_slave(pairid);
535 slave_exit_cb(unsigned slaveid, __attribute__((unused))int stat)
537 struct lcore_resource_struct *slave = &lcore_resource[slaveid];
539 printf("Get slave %u leave info\n", slaveid);
540 if (!slave->enabled) {
541 printf("Lcore=%u not registered for it's exit\n", slaveid);
544 rte_spinlock_lock(&res_lock);
546 /* Change the state and wait master to start them */
547 slave->flags = SLAVE_RECREATE_FLAG;
549 rte_spinlock_unlock(&res_lock);
553 l2fwd_simple_forward(struct rte_mbuf *m, unsigned portid)
555 struct ether_hdr *eth;
559 struct rte_eth_dev_tx_buffer *buffer;
561 dst_port = l2fwd_dst_ports[portid];
562 eth = rte_pktmbuf_mtod(m, struct ether_hdr *);
564 /* 02:00:00:00:00:xx */
565 tmp = ð->d_addr.addr_bytes[0];
566 *((uint64_t *)tmp) = 0x000000000002 + ((uint64_t)dst_port << 40);
569 ether_addr_copy(&l2fwd_ports_eth_addr[dst_port], ð->s_addr);
571 buffer = tx_buffer[dst_port];
572 sent = rte_eth_tx_buffer(dst_port, 0, buffer, m);
574 port_statistics[dst_port].tx += sent;
577 /* main processing loop */
579 l2fwd_main_loop(void)
581 struct rte_mbuf *pkts_burst[MAX_PKT_BURST];
585 uint64_t prev_tsc, diff_tsc, cur_tsc;
586 unsigned i, j, portid, nb_rx;
587 struct lcore_queue_conf *qconf;
588 const uint64_t drain_tsc = (rte_get_tsc_hz() + US_PER_S - 1) / US_PER_S *
590 struct rte_eth_dev_tx_buffer *buffer;
594 lcore_id = rte_lcore_id();
596 qconf = &lcore_queue_conf[lcore_id];
598 if (qconf->n_rx_port == 0) {
599 RTE_LOG(INFO, L2FWD, "lcore %u has nothing to do\n", lcore_id);
603 RTE_LOG(INFO, L2FWD, "entering main loop on lcore %u\n", lcore_id);
605 for (i = 0; i < qconf->n_rx_port; i++) {
606 portid = qconf->rx_port_list[i];
607 RTE_LOG(INFO, L2FWD, " -- lcoreid=%u portid=%u\n", lcore_id,
613 cur_tsc = rte_rdtsc();
615 if (unlikely(getcmd(lcore_id, &cmd, 0) == 0)) {
616 sendcmd(lcore_id, cmd, 0);
618 /* If get stop command, stop forwarding and exit */
619 if (cmd == CMD_STOP) {
625 * TX burst queue drain
627 diff_tsc = cur_tsc - prev_tsc;
628 if (unlikely(diff_tsc > drain_tsc)) {
630 for (i = 0; i < qconf->n_rx_port; i++) {
632 portid = l2fwd_dst_ports[qconf->rx_port_list[i]];
633 buffer = tx_buffer[portid];
635 sent = rte_eth_tx_buffer_flush(portid, 0, buffer);
637 port_statistics[portid].tx += sent;
645 * Read packet from RX queues
647 for (i = 0; i < qconf->n_rx_port; i++) {
649 portid = qconf->rx_port_list[i];
650 nb_rx = rte_eth_rx_burst((uint8_t) portid, 0,
651 pkts_burst, MAX_PKT_BURST);
653 port_statistics[portid].rx += nb_rx;
655 for (j = 0; j < nb_rx; j++) {
657 rte_prefetch0(rte_pktmbuf_mtod(m, void *));
658 l2fwd_simple_forward(m, portid);
665 l2fwd_launch_one_lcore(__attribute__((unused)) void *dummy)
667 unsigned lcore_id = rte_lcore_id();
672 /* Change it to floating process, also change it's lcore_id */
673 clear_cpu_affinity();
674 RTE_PER_LCORE(_lcore_id) = 0;
676 if (flib_assign_lcore_id() < 0 ) {
677 printf("flib_assign_lcore_id failed\n");
680 flcore_id = rte_lcore_id();
681 /* Set mapping id, so master can return it after slave exited */
682 mapping_id[lcore_id] = flcore_id;
683 printf("Org lcore_id = %u, cur lcore_id = %u\n",
684 lcore_id, flcore_id);
685 remapping_slave_resource(lcore_id, flcore_id);
690 /* return lcore_id before return */
692 flib_free_lcore_id(rte_lcore_id());
693 mapping_id[lcore_id] = INVALID_MAPPING_ID;
700 l2fwd_usage(const char *prgname)
702 printf("%s [EAL options] -- -p PORTMASK -s COREMASK [-q NQ] -f\n"
703 " -p PORTMASK: hexadecimal bitmask of ports to configure\n"
704 " -q NQ: number of queue (=ports) per lcore (default is 1)\n"
705 " -f use floating process which won't bind to any core to run\n"
706 " -T PERIOD: statistics will be refreshed each PERIOD seconds (0 to disable, 10 default, 86400 maximum)\n",
711 l2fwd_parse_portmask(const char *portmask)
716 /* parse hexadecimal string */
717 pm = strtoul(portmask, &end, 16);
718 if ((portmask[0] == '\0') || (end == NULL) || (*end != '\0'))
728 l2fwd_parse_nqueue(const char *q_arg)
733 /* parse hexadecimal string */
734 n = strtoul(q_arg, &end, 10);
735 if ((q_arg[0] == '\0') || (end == NULL) || (*end != '\0'))
739 if (n >= MAX_RX_QUEUE_PER_LCORE)
746 l2fwd_parse_timer_period(const char *q_arg)
751 /* parse number string */
752 n = strtol(q_arg, &end, 10);
753 if ((q_arg[0] == '\0') || (end == NULL) || (*end != '\0'))
755 if (n >= MAX_TIMER_PERIOD)
761 /* Parse the argument given in the command line of the application */
763 l2fwd_parse_args(int argc, char **argv)
768 char *prgname = argv[0];
769 static struct option lgopts[] = {
776 while ((opt = getopt_long(argc, argvopt, "p:q:T:f",
777 lgopts, &option_index)) != EOF) {
782 l2fwd_enabled_port_mask = l2fwd_parse_portmask(optarg);
783 if (l2fwd_enabled_port_mask == 0) {
784 printf("invalid portmask\n");
785 l2fwd_usage(prgname);
793 l2fwd_rx_queue_per_lcore = l2fwd_parse_nqueue(optarg);
794 if (l2fwd_rx_queue_per_lcore == 0) {
795 printf("invalid queue number\n");
796 l2fwd_usage(prgname);
803 timer_period = l2fwd_parse_timer_period(optarg) * 1000 * TIMER_MILLISECOND;
804 if (timer_period < 0) {
805 printf("invalid timer period\n");
806 l2fwd_usage(prgname);
811 /* use floating process */
818 l2fwd_usage(prgname);
822 l2fwd_usage(prgname);
828 argv[optind-1] = prgname;
831 l2fwd_usage(prgname);
835 optind = 1; /* reset getopt lib */
839 /* Check the link status of all ports in up to 9s, and print them finally */
841 check_all_ports_link_status(uint16_t port_num, uint32_t port_mask)
843 #define CHECK_INTERVAL 100 /* 100ms */
844 #define MAX_CHECK_TIME 90 /* 9s (90 * 100ms) in total */
846 uint8_t count, all_ports_up, print_flag = 0;
847 struct rte_eth_link link;
849 printf("\nChecking link status");
851 for (count = 0; count <= MAX_CHECK_TIME; count++) {
853 for (portid = 0; portid < port_num; portid++) {
854 if ((port_mask & (1 << portid)) == 0)
856 memset(&link, 0, sizeof(link));
857 rte_eth_link_get_nowait(portid, &link);
858 /* print link status if flag set */
859 if (print_flag == 1) {
860 if (link.link_status)
862 "Port%d Link Up- speed %u Mbps- %s\n",
863 portid, link.link_speed,
864 (link.link_duplex == ETH_LINK_FULL_DUPLEX) ?
865 ("full-duplex") : ("half-duplex\n"));
867 printf("Port %d Link Down\n", portid);
870 /* clear all_ports_up flag if any link down */
871 if (link.link_status == ETH_LINK_DOWN) {
876 /* after finally printing all link status, get out */
880 if (all_ports_up == 0) {
883 rte_delay_ms(CHECK_INTERVAL);
886 /* set the print_flag if all ports up or timeout */
887 if (all_ports_up == 1 || count == (MAX_CHECK_TIME - 1)) {
895 main(int argc, char **argv)
897 struct lcore_queue_conf *qconf;
900 uint16_t nb_ports_available;
901 uint16_t portid, last_port;
902 unsigned rx_lcore_id;
903 unsigned nb_ports_in_mask = 0;
905 uint64_t prev_tsc, diff_tsc, cur_tsc, timer_tsc;
907 /* Save cpu_affinity first, restore it in case it's floating process option */
908 if (get_cpu_affinity() != 0)
909 rte_exit(EXIT_FAILURE, "get_cpu_affinity error\n");
911 /* Also tries to set cpu affinity to detect whether it will fail in child process */
912 if(clear_cpu_affinity() != 0)
913 rte_exit(EXIT_FAILURE, "clear_cpu_affinity error\n");
916 ret = rte_eal_init(argc, argv);
918 rte_exit(EXIT_FAILURE, "Invalid EAL arguments\n");
922 /* parse application arguments (after the EAL ones) */
923 ret = l2fwd_parse_args(argc, argv);
925 rte_exit(EXIT_FAILURE, "Invalid L2FWD arguments\n");
928 if (flib_init() != 0)
929 rte_exit(EXIT_FAILURE, "flib init error");
932 * Allocated structures that slave lcore would change. For those that slaves are
933 * read only, needn't use malloc to share and global or static variables is ok since
934 * slave inherit all the knowledge that master initialized.
936 if (l2fwd_malloc_shared_struct() != 0)
937 rte_exit(EXIT_FAILURE, "malloc mem failed\n");
939 /* Initialize lcore_resource structures */
940 memset(lcore_resource, 0, sizeof(lcore_resource));
941 for (i = 0; i < RTE_MAX_LCORE; i++)
942 lcore_resource[i].lcore_id = i;
944 nb_ports = rte_eth_dev_count();
946 rte_exit(EXIT_FAILURE, "No Ethernet ports - bye\n");
948 /* create the mbuf pool */
949 for (portid = 0; portid < nb_ports; portid++) {
950 /* skip ports that are not enabled */
951 if ((l2fwd_enabled_port_mask & (1 << portid)) == 0)
953 char buf_name[RTE_MEMPOOL_NAMESIZE];
954 snprintf(buf_name, RTE_MEMPOOL_NAMESIZE, MBUF_NAME, portid);
955 l2fwd_pktmbuf_pool[portid] =
956 rte_pktmbuf_pool_create(buf_name, NB_MBUF, 32,
957 0, MBUF_DATA_SIZE, rte_socket_id());
958 if (l2fwd_pktmbuf_pool[portid] == NULL)
959 rte_exit(EXIT_FAILURE, "Cannot create mbuf pool\n");
961 printf("Create mbuf %s\n", buf_name);
964 /* reset l2fwd_dst_ports */
965 for (portid = 0; portid < RTE_MAX_ETHPORTS; portid++)
966 l2fwd_dst_ports[portid] = 0;
970 * Each logical core is assigned a dedicated TX queue on each port.
972 for (portid = 0; portid < nb_ports; portid++) {
973 /* skip ports that are not enabled */
974 if ((l2fwd_enabled_port_mask & (1 << portid)) == 0)
977 if (nb_ports_in_mask % 2) {
978 l2fwd_dst_ports[portid] = last_port;
979 l2fwd_dst_ports[last_port] = portid;
986 if (nb_ports_in_mask % 2) {
987 printf("Notice: odd number of ports in portmask.\n");
988 l2fwd_dst_ports[last_port] = last_port;
994 /* Initialize the port/queue configuration of each logical core */
995 for (portid = 0; portid < nb_ports; portid++) {
996 struct lcore_resource_struct *res;
997 /* skip ports that are not enabled */
998 if ((l2fwd_enabled_port_mask & (1 << portid)) == 0)
1001 /* get the lcore_id for this port */
1002 /* skip master lcore */
1003 while (rte_lcore_is_enabled(rx_lcore_id) == 0 ||
1004 rte_get_master_lcore() == rx_lcore_id ||
1005 lcore_queue_conf[rx_lcore_id].n_rx_port ==
1006 l2fwd_rx_queue_per_lcore) {
1009 if (rx_lcore_id >= RTE_MAX_LCORE)
1010 rte_exit(EXIT_FAILURE, "Not enough cores\n");
1013 if (qconf != &lcore_queue_conf[rx_lcore_id])
1014 /* Assigned a new logical core in the loop above. */
1015 qconf = &lcore_queue_conf[rx_lcore_id];
1017 qconf->rx_port_list[qconf->n_rx_port] = portid;
1020 /* Save the port resource info into lcore_resource strucutres */
1021 res = &lcore_resource[rx_lcore_id];
1023 res->port[res->port_num++] = portid;
1025 printf("Lcore %u: RX port %u\n", rx_lcore_id, (unsigned) portid);
1028 nb_ports_available = nb_ports;
1030 /* Initialise each port */
1031 for (portid = 0; portid < nb_ports; portid++) {
1032 struct rte_eth_rxconf rxq_conf;
1033 struct rte_eth_txconf txq_conf;
1034 struct rte_eth_conf local_port_conf = port_conf;
1036 /* skip ports that are not enabled */
1037 if ((l2fwd_enabled_port_mask & (1 << portid)) == 0) {
1038 printf("Skipping disabled port %u\n", (unsigned) portid);
1039 nb_ports_available--;
1043 printf("Initializing port %u... ", (unsigned) portid);
1045 rte_eth_dev_info_get(portid, &dev_info);
1046 if (dev_info.tx_offload_capa & DEV_TX_OFFLOAD_MBUF_FAST_FREE)
1047 local_port_conf.txmode.offloads |=
1048 DEV_TX_OFFLOAD_MBUF_FAST_FREE;
1049 ret = rte_eth_dev_configure(portid, 1, 1, &local_port_conf);
1051 rte_exit(EXIT_FAILURE, "Cannot configure device: err=%d, port=%u\n",
1052 ret, (unsigned) portid);
1054 ret = rte_eth_dev_adjust_nb_rx_tx_desc(portid, &nb_rxd,
1057 rte_exit(EXIT_FAILURE,
1058 "rte_eth_dev_adjust_nb_rx_tx_desc: err=%d, port=%u\n",
1059 ret, (unsigned) portid);
1061 rte_eth_macaddr_get(portid,&l2fwd_ports_eth_addr[portid]);
1063 /* init one RX queue */
1065 rxq_conf = dev_info.default_rxconf;
1066 rxq_conf.offloads = local_port_conf.rxmode.offloads;
1067 ret = rte_eth_rx_queue_setup(portid, 0, nb_rxd,
1068 rte_eth_dev_socket_id(portid),
1070 l2fwd_pktmbuf_pool[portid]);
1072 rte_exit(EXIT_FAILURE, "rte_eth_rx_queue_setup:err=%d, port=%u\n",
1073 ret, (unsigned) portid);
1075 /* init one TX queue on each port */
1077 txq_conf = dev_info.default_txconf;
1078 txq_conf.txq_flags = ETH_TXQ_FLAGS_IGNORE;
1079 txq_conf.tx_offloads = local_port_conf.txmode.offloads;
1080 ret = rte_eth_tx_queue_setup(portid, 0, nb_txd,
1081 rte_eth_dev_socket_id(portid),
1084 rte_exit(EXIT_FAILURE, "rte_eth_tx_queue_setup:err=%d, port=%u\n",
1085 ret, (unsigned) portid);
1087 /* Initialize TX buffers */
1088 tx_buffer[portid] = rte_zmalloc_socket("tx_buffer",
1089 RTE_ETH_TX_BUFFER_SIZE(MAX_PKT_BURST), 0,
1090 rte_eth_dev_socket_id(portid));
1091 if (tx_buffer[portid] == NULL)
1092 rte_exit(EXIT_FAILURE, "Cannot allocate buffer for tx on port %u\n",
1095 rte_eth_tx_buffer_init(tx_buffer[portid], MAX_PKT_BURST);
1097 ret = rte_eth_tx_buffer_set_err_callback(tx_buffer[portid],
1098 rte_eth_tx_buffer_count_callback,
1099 &port_statistics[portid].dropped);
1101 rte_exit(EXIT_FAILURE, "Cannot set error callback for "
1102 "tx buffer on port %u\n", (unsigned) portid);
1105 ret = rte_eth_dev_start(portid);
1107 rte_exit(EXIT_FAILURE, "rte_eth_dev_start:err=%d, port=%u\n",
1108 ret, (unsigned) portid);
1112 rte_eth_promiscuous_enable(portid);
1114 printf("Port %u, MAC address: %02X:%02X:%02X:%02X:%02X:%02X\n\n",
1116 l2fwd_ports_eth_addr[portid].addr_bytes[0],
1117 l2fwd_ports_eth_addr[portid].addr_bytes[1],
1118 l2fwd_ports_eth_addr[portid].addr_bytes[2],
1119 l2fwd_ports_eth_addr[portid].addr_bytes[3],
1120 l2fwd_ports_eth_addr[portid].addr_bytes[4],
1121 l2fwd_ports_eth_addr[portid].addr_bytes[5]);
1123 /* initialize port stats */
1124 //memset(&port_statistics, 0, sizeof(port_statistics));
1127 if (!nb_ports_available) {
1128 rte_exit(EXIT_FAILURE,
1129 "All available ports are disabled. Please set portmask.\n");
1132 check_all_ports_link_status(nb_ports, l2fwd_enabled_port_mask);
1134 /* Record pair lcore */
1136 * Since l2fwd example would create pair between different neighbour port, that's
1137 * port 0 receive and forward to port 1, the same to port 1, these 2 ports will have
1138 * dependency. If one port stopped working (killed, for example), the port need to
1139 * be stopped/started again. During the time, another port need to wait until stop/start
1140 * procedure completed. So, record the pair relationship for those lcores working
1143 for (portid = 0; portid < nb_ports; portid++) {
1145 unsigned lcore = 0, pair_lcore = 0;
1146 unsigned j, find_lcore, find_pair_lcore;
1147 /* skip ports that are not enabled */
1148 if ((l2fwd_enabled_port_mask & (1 << portid)) == 0)
1151 /* Find pair ports' lcores */
1152 find_lcore = find_pair_lcore = 0;
1153 pair_port = l2fwd_dst_ports[portid];
1154 for (i = 0; i < RTE_MAX_LCORE; i++) {
1155 if (!rte_lcore_is_enabled(i))
1157 for (j = 0; j < lcore_queue_conf[i].n_rx_port;j++) {
1158 if (lcore_queue_conf[i].rx_port_list[j] == portid) {
1163 if (lcore_queue_conf[i].rx_port_list[j] == pair_port) {
1165 find_pair_lcore = 1;
1169 if (find_lcore && find_pair_lcore)
1172 if (!find_lcore || !find_pair_lcore)
1173 rte_exit(EXIT_FAILURE, "Not find port=%d pair\n", portid);
1175 printf("lcore %u and %u paired\n", lcore, pair_lcore);
1176 lcore_resource[lcore].pair_id = pair_lcore;
1177 lcore_resource[pair_lcore].pair_id = lcore;
1180 /* Create message buffer for all master and slave */
1181 message_pool = rte_mempool_create("ms_msg_pool",
1182 NB_CORE_MSGBUF * RTE_MAX_LCORE,
1183 sizeof(enum l2fwd_cmd), NB_CORE_MSGBUF / 2,
1184 0, NULL, NULL, NULL, NULL, rte_socket_id(), 0);
1186 if (message_pool == NULL)
1187 rte_exit(EXIT_FAILURE, "Create msg mempool failed\n");
1189 /* Create ring for each master and slave pair, also register cb when slave leaves */
1190 for (i = 0; i < RTE_MAX_LCORE; i++) {
1192 * Only create ring and register slave_exit cb in case that core involved into
1195 if (lcore_resource[i].enabled) {
1196 /* Create ring for master and slave communication */
1197 ret = create_ms_ring(i);
1199 rte_exit(EXIT_FAILURE, "Create ring for lcore=%u failed",
1202 if (flib_register_slave_exit_notify(i,
1203 slave_exit_cb) != 0)
1204 rte_exit(EXIT_FAILURE,
1205 "Register master_trace_slave_exit failed");
1209 /* launch per-lcore init on every lcore except master */
1210 flib_mp_remote_launch(l2fwd_launch_one_lcore, NULL, SKIP_MASTER);
1212 /* print statistics 10 second */
1213 prev_tsc = cur_tsc = rte_rdtsc();
1217 cur_tsc = rte_rdtsc();
1218 diff_tsc = cur_tsc - prev_tsc;
1219 /* if timer is enabled */
1220 if (timer_period > 0) {
1222 /* advance the timer */
1223 timer_tsc += diff_tsc;
1225 /* if timer has reached its timeout */
1226 if (unlikely(timer_tsc >= (uint64_t) timer_period)) {
1229 /* reset the timer */
1236 /* Check any slave need restart or recreate */
1237 rte_spinlock_lock(&res_lock);
1238 for (i = 0; i < RTE_MAX_LCORE; i++) {
1239 struct lcore_resource_struct *res = &lcore_resource[i];
1240 struct lcore_resource_struct *pair = &lcore_resource[res->pair_id];
1242 /* If find slave exited, try to reset pair */
1243 if (res->enabled && res->flags && pair->enabled) {
1245 master_sendcmd_with_ack(pair->lcore_id, CMD_STOP);
1246 rte_spinlock_unlock(&res_lock);
1248 rte_spinlock_lock(&res_lock);
1252 if (reset_pair(res->lcore_id, pair->lcore_id) != 0)
1253 rte_exit(EXIT_FAILURE, "failed to reset slave");
1258 rte_spinlock_unlock(&res_lock);