examples: check status of getting link info
[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 = RTE_ETHER_MAX_LEN,
61                 .split_hdr_size = 0,
62         },
63         .txmode = {
64                 .mq_mode = ETH_DCB_NONE,
65         },
66 };
67
68 static int
69 app_init_port(uint16_t portid, struct rte_mempool *mp)
70 {
71         int ret;
72         struct rte_eth_link link;
73         struct rte_eth_dev_info dev_info;
74         struct rte_eth_rxconf rx_conf;
75         struct rte_eth_txconf tx_conf;
76         uint16_t rx_size;
77         uint16_t tx_size;
78         struct rte_eth_conf local_port_conf = port_conf;
79
80         /* check if port already initialized (multistream configuration) */
81         if (app_inited_port_mask & (1u << portid))
82                 return 0;
83
84         rx_conf.rx_thresh.pthresh = rx_thresh.pthresh;
85         rx_conf.rx_thresh.hthresh = rx_thresh.hthresh;
86         rx_conf.rx_thresh.wthresh = rx_thresh.wthresh;
87         rx_conf.rx_free_thresh = 32;
88         rx_conf.rx_drop_en = 0;
89         rx_conf.rx_deferred_start = 0;
90
91         tx_conf.tx_thresh.pthresh = tx_thresh.pthresh;
92         tx_conf.tx_thresh.hthresh = tx_thresh.hthresh;
93         tx_conf.tx_thresh.wthresh = tx_thresh.wthresh;
94         tx_conf.tx_free_thresh = 0;
95         tx_conf.tx_rs_thresh = 0;
96         tx_conf.tx_deferred_start = 0;
97
98         /* init port */
99         RTE_LOG(INFO, APP, "Initializing port %"PRIu16"... ", portid);
100         fflush(stdout);
101
102         ret = rte_eth_dev_info_get(portid, &dev_info);
103         if (ret != 0)
104                 rte_exit(EXIT_FAILURE,
105                         "Error during getting device (port %u) info: %s\n",
106                         portid, strerror(-ret));
107
108         if (dev_info.tx_offload_capa & DEV_TX_OFFLOAD_MBUF_FAST_FREE)
109                 local_port_conf.txmode.offloads |=
110                         DEV_TX_OFFLOAD_MBUF_FAST_FREE;
111         ret = rte_eth_dev_configure(portid, 1, 1, &local_port_conf);
112         if (ret < 0)
113                 rte_exit(EXIT_FAILURE,
114                          "Cannot configure device: err=%d, port=%u\n",
115                          ret, portid);
116
117         rx_size = ring_conf.rx_size;
118         tx_size = ring_conf.tx_size;
119         ret = rte_eth_dev_adjust_nb_rx_tx_desc(portid, &rx_size, &tx_size);
120         if (ret < 0)
121                 rte_exit(EXIT_FAILURE,
122                          "rte_eth_dev_adjust_nb_rx_tx_desc: err=%d,port=%u\n",
123                          ret, portid);
124         ring_conf.rx_size = rx_size;
125         ring_conf.tx_size = tx_size;
126
127         /* init one RX queue */
128         fflush(stdout);
129         rx_conf.offloads = local_port_conf.rxmode.offloads;
130         ret = rte_eth_rx_queue_setup(portid, 0, (uint16_t)ring_conf.rx_size,
131                 rte_eth_dev_socket_id(portid), &rx_conf, mp);
132         if (ret < 0)
133                 rte_exit(EXIT_FAILURE,
134                          "rte_eth_tx_queue_setup: err=%d, port=%u\n",
135                          ret, portid);
136
137         /* init one TX queue */
138         fflush(stdout);
139         tx_conf.offloads = local_port_conf.txmode.offloads;
140         ret = rte_eth_tx_queue_setup(portid, 0,
141                 (uint16_t)ring_conf.tx_size, rte_eth_dev_socket_id(portid), &tx_conf);
142         if (ret < 0)
143                 rte_exit(EXIT_FAILURE,
144                          "rte_eth_tx_queue_setup: err=%d, port=%u queue=%d\n",
145                          ret, portid, 0);
146
147         /* Start device */
148         ret = rte_eth_dev_start(portid);
149         if (ret < 0)
150                 rte_exit(EXIT_FAILURE,
151                          "rte_pmd_port_start: err=%d, port=%u\n",
152                          ret, portid);
153
154         printf("done: ");
155
156         /* get link status */
157         ret = rte_eth_link_get(portid, &link);
158         if (ret < 0)
159                 rte_exit(EXIT_FAILURE,
160                          "rte_eth_link_get: err=%d, port=%u: %s\n",
161                          ret, portid, rte_strerror(-ret));
162
163         if (link.link_status) {
164                 printf(" Link Up - speed %u Mbps - %s\n",
165                         (uint32_t) link.link_speed,
166                         (link.link_duplex == ETH_LINK_FULL_DUPLEX) ?
167                         ("full-duplex") : ("half-duplex\n"));
168         } else {
169                 printf(" Link Down\n");
170         }
171         ret = rte_eth_promiscuous_enable(portid);
172         if (ret != 0)
173                 rte_exit(EXIT_FAILURE,
174                         "rte_eth_promiscuous_enable: err=%s, port=%u\n",
175                         rte_strerror(-ret), portid);
176
177         /* mark port as initialized */
178         app_inited_port_mask |= 1u << portid;
179
180         return 0;
181 }
182
183 static struct rte_sched_subport_params subport_params[MAX_SCHED_SUBPORTS] = {
184         {
185                 .tb_rate = 1250000000,
186                 .tb_size = 1000000,
187
188                 .tc_rate = {1250000000, 1250000000, 1250000000, 1250000000,
189                         1250000000, 1250000000, 1250000000, 1250000000, 1250000000,
190                         1250000000, 1250000000, 1250000000, 1250000000},
191                 .tc_period = 10,
192         },
193 };
194
195 static struct rte_sched_pipe_params pipe_profiles[MAX_SCHED_PIPE_PROFILES] = {
196         { /* Profile #0 */
197                 .tb_rate = 305175,
198                 .tb_size = 1000000,
199
200                 .tc_rate = {305175, 305175, 305175, 305175, 305175, 305175,
201                         305175, 305175, 305175, 305175, 305175, 305175, 305175},
202                 .tc_period = 40,
203 #ifdef RTE_SCHED_SUBPORT_TC_OV
204                 .tc_ov_weight = 1,
205 #endif
206
207                 .wrr_weights = {1, 1, 1, 1},
208         },
209 };
210
211 struct rte_sched_port_params port_params = {
212         .name = "port_scheduler_0",
213         .socket = 0, /* computed */
214         .rate = 0, /* computed */
215         .mtu = 6 + 6 + 4 + 4 + 2 + 1500,
216         .frame_overhead = RTE_SCHED_FRAME_OVERHEAD_DEFAULT,
217         .n_subports_per_port = 1,
218         .n_pipes_per_subport = 4096,
219         .qsize = {64, 64, 64, 64, 64, 64, 64, 64, 64, 64, 64, 64, 64},
220         .pipe_profiles = pipe_profiles,
221         .n_pipe_profiles = sizeof(pipe_profiles) / sizeof(struct rte_sched_pipe_params),
222         .n_max_pipe_profiles = MAX_SCHED_PIPE_PROFILES,
223
224 #ifdef RTE_SCHED_RED
225         .red_params = {
226                 /* Traffic Class 0 Colors Green / Yellow / Red */
227                 [0][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
228                 [0][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
229                 [0][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
230
231                 /* Traffic Class 1 - Colors Green / Yellow / Red */
232                 [1][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
233                 [1][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
234                 [1][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
235
236                 /* Traffic Class 2 - Colors Green / Yellow / Red */
237                 [2][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
238                 [2][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
239                 [2][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
240
241                 /* Traffic Class 3 - Colors Green / Yellow / Red */
242                 [3][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
243                 [3][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
244                 [3][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
245
246                 /* Traffic Class 4 - Colors Green / Yellow / Red */
247                 [4][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
248                 [4][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
249                 [4][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
250
251                 /* Traffic Class 5 - Colors Green / Yellow / Red */
252                 [5][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
253                 [5][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
254                 [5][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
255
256                 /* Traffic Class 6 - Colors Green / Yellow / Red */
257                 [6][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
258                 [6][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
259                 [6][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
260
261                 /* Traffic Class 7 - Colors Green / Yellow / Red */
262                 [7][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
263                 [7][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
264                 [7][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
265
266                 /* Traffic Class 8 - Colors Green / Yellow / Red */
267                 [8][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
268                 [8][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
269                 [8][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
270
271                 /* Traffic Class 9 - Colors Green / Yellow / Red */
272                 [9][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
273                 [9][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
274                 [9][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
275
276                 /* Traffic Class 10 - Colors Green / Yellow / Red */
277                 [10][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
278                 [10][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
279                 [10][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
280
281                 /* Traffic Class 11 - Colors Green / Yellow / Red */
282                 [11][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
283                 [11][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
284                 [11][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
285
286                 /* Traffic Class 12 - Colors Green / Yellow / Red */
287                 [12][0] = {.min_th = 48, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
288                 [12][1] = {.min_th = 40, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
289                 [12][2] = {.min_th = 32, .max_th = 64, .maxp_inv = 10, .wq_log2 = 9},
290         },
291 #endif /* RTE_SCHED_RED */
292 };
293
294 static struct rte_sched_port *
295 app_init_sched_port(uint32_t portid, uint32_t socketid)
296 {
297         static char port_name[32]; /* static as referenced from global port_params*/
298         struct rte_eth_link link;
299         struct rte_sched_port *port = NULL;
300         uint32_t pipe, subport;
301         int err;
302
303         err = rte_eth_link_get(portid, &link);
304         if (err < 0)
305                 rte_exit(EXIT_FAILURE,
306                          "rte_eth_link_get: err=%d, port=%u: %s\n",
307                          err, portid, rte_strerror(-err));
308
309         port_params.socket = socketid;
310         port_params.rate = (uint64_t) link.link_speed * 1000 * 1000 / 8;
311         snprintf(port_name, sizeof(port_name), "port_%d", portid);
312         port_params.name = port_name;
313
314         port = rte_sched_port_config(&port_params);
315         if (port == NULL){
316                 rte_exit(EXIT_FAILURE, "Unable to config sched port\n");
317         }
318
319         for (subport = 0; subport < port_params.n_subports_per_port; subport ++) {
320                 err = rte_sched_subport_config(port, subport, &subport_params[subport]);
321                 if (err) {
322                         rte_exit(EXIT_FAILURE, "Unable to config sched subport %u, err=%d\n",
323                                         subport, err);
324                 }
325
326                 for (pipe = 0; pipe < port_params.n_pipes_per_subport; pipe++) {
327                         if (app_pipe_to_profile[subport][pipe] != -1) {
328                                 err = rte_sched_pipe_config(port, subport, pipe,
329                                                 app_pipe_to_profile[subport][pipe]);
330                                 if (err) {
331                                         rte_exit(EXIT_FAILURE, "Unable to config sched pipe %u "
332                                                         "for profile %d, err=%d\n", pipe,
333                                                         app_pipe_to_profile[subport][pipe], err);
334                                 }
335                         }
336                 }
337         }
338
339         return port;
340 }
341
342 static int
343 app_load_cfg_profile(const char *profile)
344 {
345         if (profile == NULL)
346                 return 0;
347         struct rte_cfgfile *file = rte_cfgfile_load(profile, 0);
348         if (file == NULL)
349                 rte_exit(EXIT_FAILURE, "Cannot load configuration profile %s\n", profile);
350
351         cfg_load_port(file, &port_params);
352         cfg_load_subport(file, subport_params);
353         cfg_load_pipe(file, pipe_profiles);
354
355         rte_cfgfile_close(file);
356
357         return 0;
358 }
359
360 int app_init(void)
361 {
362         uint32_t i;
363         char ring_name[MAX_NAME_LEN];
364         char pool_name[MAX_NAME_LEN];
365
366         if (rte_eth_dev_count_avail() == 0)
367                 rte_exit(EXIT_FAILURE, "No Ethernet port - bye\n");
368
369         /* load configuration profile */
370         if (app_load_cfg_profile(cfg_profile) != 0)
371                 rte_exit(EXIT_FAILURE, "Invalid configuration profile\n");
372
373         /* Initialize each active flow */
374         for(i = 0; i < nb_pfc; i++) {
375                 uint32_t socket = rte_lcore_to_socket_id(qos_conf[i].rx_core);
376                 struct rte_ring *ring;
377
378                 snprintf(ring_name, MAX_NAME_LEN, "ring-%u-%u", i, qos_conf[i].rx_core);
379                 ring = rte_ring_lookup(ring_name);
380                 if (ring == NULL)
381                         qos_conf[i].rx_ring = rte_ring_create(ring_name, ring_conf.ring_size,
382                                 socket, RING_F_SP_ENQ | RING_F_SC_DEQ);
383                 else
384                         qos_conf[i].rx_ring = ring;
385
386                 snprintf(ring_name, MAX_NAME_LEN, "ring-%u-%u", i, qos_conf[i].tx_core);
387                 ring = rte_ring_lookup(ring_name);
388                 if (ring == NULL)
389                         qos_conf[i].tx_ring = rte_ring_create(ring_name, ring_conf.ring_size,
390                                 socket, RING_F_SP_ENQ | RING_F_SC_DEQ);
391                 else
392                         qos_conf[i].tx_ring = ring;
393
394
395                 /* create the mbuf pools for each RX Port */
396                 snprintf(pool_name, MAX_NAME_LEN, "mbuf_pool%u", i);
397                 qos_conf[i].mbuf_pool = rte_pktmbuf_pool_create(pool_name,
398                         mp_size, burst_conf.rx_burst * 4, 0,
399                         RTE_MBUF_DEFAULT_BUF_SIZE,
400                         rte_eth_dev_socket_id(qos_conf[i].rx_port));
401                 if (qos_conf[i].mbuf_pool == NULL)
402                         rte_exit(EXIT_FAILURE, "Cannot init mbuf pool for socket %u\n", i);
403
404                 app_init_port(qos_conf[i].rx_port, qos_conf[i].mbuf_pool);
405                 app_init_port(qos_conf[i].tx_port, qos_conf[i].mbuf_pool);
406
407                 qos_conf[i].sched_port = app_init_sched_port(qos_conf[i].tx_port, socket);
408         }
409
410         RTE_LOG(INFO, APP, "time stamp clock running at %" PRIu64 " Hz\n",
411                          rte_get_timer_hz());
412
413         RTE_LOG(INFO, APP, "Ring sizes: NIC RX = %u, Mempool = %d SW queue = %u,"
414                          "NIC TX = %u\n", ring_conf.rx_size, mp_size, ring_conf.ring_size,
415                          ring_conf.tx_size);
416
417         RTE_LOG(INFO, APP, "Burst sizes: RX read = %hu, RX write = %hu,\n"
418                                                   "             Worker read/QoS enqueue = %hu,\n"
419                                                   "             QoS dequeue = %hu, Worker write = %hu\n",
420                 burst_conf.rx_burst, burst_conf.ring_burst, burst_conf.ring_burst,
421                 burst_conf.qos_dequeue, burst_conf.tx_burst);
422
423         RTE_LOG(INFO, APP, "NIC thresholds RX (p = %hhu, h = %hhu, w = %hhu),"
424                                  "TX (p = %hhu, h = %hhu, w = %hhu)\n",
425                 rx_thresh.pthresh, rx_thresh.hthresh, rx_thresh.wthresh,
426                 tx_thresh.pthresh, tx_thresh.hthresh, tx_thresh.wthresh);
427
428         return 0;
429 }