New upstream version 18.08
[deb_dpdk.git] / examples / qos_sched / init.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2010-2014 Intel Corporation
3  */
4
5 #include <stdint.h>
6 #include <memory.h>
7
8 #include <rte_log.h>
9 #include <rte_mbuf.h>
10 #include <rte_debug.h>
11 #include <rte_ethdev.h>
12 #include <rte_mempool.h>
13 #include <rte_sched.h>
14 #include <rte_cycles.h>
15 #include <rte_string_fns.h>
16 #include <rte_cfgfile.h>
17
18 #include "main.h"
19 #include "cfg_file.h"
20
21 uint32_t app_numa_mask = 0;
22 static uint32_t app_inited_port_mask = 0;
23
24 int app_pipe_to_profile[MAX_SCHED_SUBPORTS][MAX_SCHED_PIPES];
25
26 #define MAX_NAME_LEN 32
27
28 struct ring_conf ring_conf = {
29         .rx_size   = APP_RX_DESC_DEFAULT,
30         .ring_size = APP_RING_SIZE,
31         .tx_size   = APP_TX_DESC_DEFAULT,
32 };
33
34 struct burst_conf burst_conf = {
35         .rx_burst    = MAX_PKT_RX_BURST,
36         .ring_burst  = PKT_ENQUEUE,
37         .qos_dequeue = PKT_DEQUEUE,
38         .tx_burst    = MAX_PKT_TX_BURST,
39 };
40
41 struct ring_thresh rx_thresh = {
42         .pthresh = RX_PTHRESH,
43         .hthresh = RX_HTHRESH,
44         .wthresh = RX_WTHRESH,
45 };
46
47 struct ring_thresh tx_thresh = {
48         .pthresh = TX_PTHRESH,
49         .hthresh = TX_HTHRESH,
50         .wthresh = TX_WTHRESH,
51 };
52
53 uint32_t nb_pfc;
54 const char *cfg_profile = NULL;
55 int mp_size = NB_MBUF;
56 struct flow_conf qos_conf[MAX_DATA_STREAMS];
57
58 static struct rte_eth_conf port_conf = {
59         .rxmode = {
60                 .max_rx_pkt_len = ETHER_MAX_LEN,
61                 .split_hdr_size = 0,
62                 .offloads = DEV_RX_OFFLOAD_CRC_STRIP,
63         },
64         .txmode = {
65                 .mq_mode = ETH_DCB_NONE,
66         },
67 };
68
69 static int
70 app_init_port(uint16_t portid, struct rte_mempool *mp)
71 {
72         int ret;
73         struct rte_eth_link link;
74         struct rte_eth_dev_info dev_info;
75         struct rte_eth_rxconf rx_conf;
76         struct rte_eth_txconf tx_conf;
77         uint16_t rx_size;
78         uint16_t tx_size;
79         struct rte_eth_conf local_port_conf = port_conf;
80
81         /* check if port already initialized (multistream configuration) */
82         if (app_inited_port_mask & (1u << portid))
83                 return 0;
84
85         rx_conf.rx_thresh.pthresh = rx_thresh.pthresh;
86         rx_conf.rx_thresh.hthresh = rx_thresh.hthresh;
87         rx_conf.rx_thresh.wthresh = rx_thresh.wthresh;
88         rx_conf.rx_free_thresh = 32;
89         rx_conf.rx_drop_en = 0;
90         rx_conf.rx_deferred_start = 0;
91
92         tx_conf.tx_thresh.pthresh = tx_thresh.pthresh;
93         tx_conf.tx_thresh.hthresh = tx_thresh.hthresh;
94         tx_conf.tx_thresh.wthresh = tx_thresh.wthresh;
95         tx_conf.tx_free_thresh = 0;
96         tx_conf.tx_rs_thresh = 0;
97         tx_conf.tx_deferred_start = 0;
98
99         /* init port */
100         RTE_LOG(INFO, APP, "Initializing port %"PRIu16"... ", portid);
101         fflush(stdout);
102         rte_eth_dev_info_get(portid, &dev_info);
103         if (dev_info.tx_offload_capa & DEV_TX_OFFLOAD_MBUF_FAST_FREE)
104                 local_port_conf.txmode.offloads |=
105                         DEV_TX_OFFLOAD_MBUF_FAST_FREE;
106         ret = rte_eth_dev_configure(portid, 1, 1, &local_port_conf);
107         if (ret < 0)
108                 rte_exit(EXIT_FAILURE,
109                          "Cannot configure device: err=%d, port=%u\n",
110                          ret, portid);
111
112         rx_size = ring_conf.rx_size;
113         tx_size = ring_conf.tx_size;
114         ret = rte_eth_dev_adjust_nb_rx_tx_desc(portid, &rx_size, &tx_size);
115         if (ret < 0)
116                 rte_exit(EXIT_FAILURE,
117                          "rte_eth_dev_adjust_nb_rx_tx_desc: err=%d,port=%u\n",
118                          ret, portid);
119         ring_conf.rx_size = rx_size;
120         ring_conf.tx_size = tx_size;
121
122         /* init one RX queue */
123         fflush(stdout);
124         rx_conf.offloads = local_port_conf.rxmode.offloads;
125         ret = rte_eth_rx_queue_setup(portid, 0, (uint16_t)ring_conf.rx_size,
126                 rte_eth_dev_socket_id(portid), &rx_conf, mp);
127         if (ret < 0)
128                 rte_exit(EXIT_FAILURE,
129                          "rte_eth_tx_queue_setup: err=%d, port=%u\n",
130                          ret, portid);
131
132         /* init one TX queue */
133         fflush(stdout);
134         tx_conf.offloads = local_port_conf.txmode.offloads;
135         ret = rte_eth_tx_queue_setup(portid, 0,
136                 (uint16_t)ring_conf.tx_size, rte_eth_dev_socket_id(portid), &tx_conf);
137         if (ret < 0)
138                 rte_exit(EXIT_FAILURE,
139                          "rte_eth_tx_queue_setup: err=%d, port=%u queue=%d\n",
140                          ret, portid, 0);
141
142         /* Start device */
143         ret = rte_eth_dev_start(portid);
144         if (ret < 0)
145                 rte_exit(EXIT_FAILURE,
146                          "rte_pmd_port_start: err=%d, port=%u\n",
147                          ret, portid);
148
149         printf("done: ");
150
151         /* get link status */
152         rte_eth_link_get(portid, &link);
153         if (link.link_status) {
154                 printf(" Link Up - speed %u Mbps - %s\n",
155                         (uint32_t) link.link_speed,
156                         (link.link_duplex == ETH_LINK_FULL_DUPLEX) ?
157                         ("full-duplex") : ("half-duplex\n"));
158         } else {
159                 printf(" Link Down\n");
160         }
161         rte_eth_promiscuous_enable(portid);
162
163         /* mark port as initialized */
164         app_inited_port_mask |= 1u << portid;
165
166         return 0;
167 }
168
169 static struct rte_sched_subport_params subport_params[MAX_SCHED_SUBPORTS] = {
170         {
171                 .tb_rate = 1250000000,
172                 .tb_size = 1000000,
173
174                 .tc_rate = {1250000000, 1250000000, 1250000000, 1250000000},
175                 .tc_period = 10,
176         },
177 };
178
179 static struct rte_sched_pipe_params pipe_profiles[RTE_SCHED_PIPE_PROFILES_PER_PORT] = {
180         { /* Profile #0 */
181                 .tb_rate = 305175,
182                 .tb_size = 1000000,
183
184                 .tc_rate = {305175, 305175, 305175, 305175},
185                 .tc_period = 40,
186 #ifdef RTE_SCHED_SUBPORT_TC_OV
187                 .tc_ov_weight = 1,
188 #endif
189
190                 .wrr_weights = {1, 1, 1, 1,  1, 1, 1, 1,  1, 1, 1, 1,  1, 1, 1, 1},
191         },
192 };
193
194 struct rte_sched_port_params port_params = {
195         .name = "port_scheduler_0",
196         .socket = 0, /* computed */
197         .rate = 0, /* computed */
198         .mtu = 6 + 6 + 4 + 4 + 2 + 1500,
199         .frame_overhead = RTE_SCHED_FRAME_OVERHEAD_DEFAULT,
200         .n_subports_per_port = 1,
201         .n_pipes_per_subport = 4096,
202         .qsize = {64, 64, 64, 64},
203         .pipe_profiles = pipe_profiles,
204         .n_pipe_profiles = sizeof(pipe_profiles) / sizeof(struct rte_sched_pipe_params),
205
206 #ifdef RTE_SCHED_RED
207         .red_params = {
208                 /* Traffic Class 0 Colors Green / Yellow / Red */
209                 [0][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
210                 [0][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
211                 [0][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
212
213                 /* Traffic Class 1 - Colors Green / Yellow / Red */
214                 [1][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
215                 [1][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
216                 [1][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
217
218                 /* Traffic Class 2 - Colors Green / Yellow / Red */
219                 [2][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
220                 [2][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
221                 [2][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
222
223                 /* Traffic Class 3 - Colors Green / Yellow / Red */
224                 [3][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
225                 [3][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
226                 [3][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9}
227         }
228 #endif /* RTE_SCHED_RED */
229 };
230
231 static struct rte_sched_port *
232 app_init_sched_port(uint32_t portid, uint32_t socketid)
233 {
234         static char port_name[32]; /* static as referenced from global port_params*/
235         struct rte_eth_link link;
236         struct rte_sched_port *port = NULL;
237         uint32_t pipe, subport;
238         int err;
239
240         rte_eth_link_get(portid, &link);
241
242         port_params.socket = socketid;
243         port_params.rate = (uint64_t) link.link_speed * 1000 * 1000 / 8;
244         snprintf(port_name, sizeof(port_name), "port_%d", portid);
245         port_params.name = port_name;
246
247         port = rte_sched_port_config(&port_params);
248         if (port == NULL){
249                 rte_exit(EXIT_FAILURE, "Unable to config sched port\n");
250         }
251
252         for (subport = 0; subport < port_params.n_subports_per_port; subport ++) {
253                 err = rte_sched_subport_config(port, subport, &subport_params[subport]);
254                 if (err) {
255                         rte_exit(EXIT_FAILURE, "Unable to config sched subport %u, err=%d\n",
256                                         subport, err);
257                 }
258
259                 for (pipe = 0; pipe < port_params.n_pipes_per_subport; pipe ++) {
260                         if (app_pipe_to_profile[subport][pipe] != -1) {
261                                 err = rte_sched_pipe_config(port, subport, pipe,
262                                                 app_pipe_to_profile[subport][pipe]);
263                                 if (err) {
264                                         rte_exit(EXIT_FAILURE, "Unable to config sched pipe %u "
265                                                         "for profile %d, err=%d\n", pipe,
266                                                         app_pipe_to_profile[subport][pipe], err);
267                                 }
268                         }
269                 }
270         }
271
272         return port;
273 }
274
275 static int
276 app_load_cfg_profile(const char *profile)
277 {
278         if (profile == NULL)
279                 return 0;
280         struct rte_cfgfile *file = rte_cfgfile_load(profile, 0);
281         if (file == NULL)
282                 rte_exit(EXIT_FAILURE, "Cannot load configuration profile %s\n", profile);
283
284         cfg_load_port(file, &port_params);
285         cfg_load_subport(file, subport_params);
286         cfg_load_pipe(file, pipe_profiles);
287
288         rte_cfgfile_close(file);
289
290         return 0;
291 }
292
293 int app_init(void)
294 {
295         uint32_t i;
296         char ring_name[MAX_NAME_LEN];
297         char pool_name[MAX_NAME_LEN];
298
299         if (rte_eth_dev_count_avail() == 0)
300                 rte_exit(EXIT_FAILURE, "No Ethernet port - bye\n");
301
302         /* load configuration profile */
303         if (app_load_cfg_profile(cfg_profile) != 0)
304                 rte_exit(EXIT_FAILURE, "Invalid configuration profile\n");
305
306         /* Initialize each active flow */
307         for(i = 0; i < nb_pfc; i++) {
308                 uint32_t socket = rte_lcore_to_socket_id(qos_conf[i].rx_core);
309                 struct rte_ring *ring;
310
311                 snprintf(ring_name, MAX_NAME_LEN, "ring-%u-%u", i, qos_conf[i].rx_core);
312                 ring = rte_ring_lookup(ring_name);
313                 if (ring == NULL)
314                         qos_conf[i].rx_ring = rte_ring_create(ring_name, ring_conf.ring_size,
315                                 socket, RING_F_SP_ENQ | RING_F_SC_DEQ);
316                 else
317                         qos_conf[i].rx_ring = ring;
318
319                 snprintf(ring_name, MAX_NAME_LEN, "ring-%u-%u", i, qos_conf[i].tx_core);
320                 ring = rte_ring_lookup(ring_name);
321                 if (ring == NULL)
322                         qos_conf[i].tx_ring = rte_ring_create(ring_name, ring_conf.ring_size,
323                                 socket, RING_F_SP_ENQ | RING_F_SC_DEQ);
324                 else
325                         qos_conf[i].tx_ring = ring;
326
327
328                 /* create the mbuf pools for each RX Port */
329                 snprintf(pool_name, MAX_NAME_LEN, "mbuf_pool%u", i);
330                 qos_conf[i].mbuf_pool = rte_pktmbuf_pool_create(pool_name,
331                         mp_size, burst_conf.rx_burst * 4, 0,
332                         RTE_MBUF_DEFAULT_BUF_SIZE,
333                         rte_eth_dev_socket_id(qos_conf[i].rx_port));
334                 if (qos_conf[i].mbuf_pool == NULL)
335                         rte_exit(EXIT_FAILURE, "Cannot init mbuf pool for socket %u\n", i);
336
337                 app_init_port(qos_conf[i].rx_port, qos_conf[i].mbuf_pool);
338                 app_init_port(qos_conf[i].tx_port, qos_conf[i].mbuf_pool);
339
340                 qos_conf[i].sched_port = app_init_sched_port(qos_conf[i].tx_port, socket);
341         }
342
343         RTE_LOG(INFO, APP, "time stamp clock running at %" PRIu64 " Hz\n",
344                          rte_get_timer_hz());
345
346         RTE_LOG(INFO, APP, "Ring sizes: NIC RX = %u, Mempool = %d SW queue = %u,"
347                          "NIC TX = %u\n", ring_conf.rx_size, mp_size, ring_conf.ring_size,
348                          ring_conf.tx_size);
349
350         RTE_LOG(INFO, APP, "Burst sizes: RX read = %hu, RX write = %hu,\n"
351                                                   "             Worker read/QoS enqueue = %hu,\n"
352                                                   "             QoS dequeue = %hu, Worker write = %hu\n",
353                 burst_conf.rx_burst, burst_conf.ring_burst, burst_conf.ring_burst,
354                 burst_conf.qos_dequeue, burst_conf.tx_burst);
355
356         RTE_LOG(INFO, APP, "NIC thresholds RX (p = %hhu, h = %hhu, w = %hhu),"
357                                  "TX (p = %hhu, h = %hhu, w = %hhu)\n",
358                 rx_thresh.pthresh, rx_thresh.hthresh, rx_thresh.wthresh,
359                 tx_thresh.pthresh, tx_thresh.hthresh, tx_thresh.wthresh);
360
361         return 0;
362 }