test mbuf attach
[dpdk.git] / examples / ip_pipeline / link.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2010-2018 Intel Corporation
3  */
4
5 #include <stdlib.h>
6 #include <string.h>
7
8 #include <rte_ethdev.h>
9 #include <rte_string_fns.h>
10
11 #include "link.h"
12 #include "mempool.h"
13
14 static struct link_list link_list;
15
16 int
17 link_init(void)
18 {
19         TAILQ_INIT(&link_list);
20
21         return 0;
22 }
23
24 struct link *
25 link_find(const char *name)
26 {
27         struct link *link;
28
29         if (name == NULL)
30                 return NULL;
31
32         TAILQ_FOREACH(link, &link_list, node)
33                 if (strcmp(link->name, name) == 0)
34                         return link;
35
36         return NULL;
37 }
38
39 struct link *
40 link_next(struct link *link)
41 {
42         return (link == NULL) ? TAILQ_FIRST(&link_list) : TAILQ_NEXT(link, node);
43 }
44
45 static struct rte_eth_conf port_conf_default = {
46         .link_speeds = 0,
47         .rxmode = {
48                 .mq_mode = ETH_MQ_RX_NONE,
49                 .max_rx_pkt_len = 9000, /* Jumbo frame max packet len */
50                 .split_hdr_size = 0, /* Header split buffer size */
51         },
52         .rx_adv_conf = {
53                 .rss_conf = {
54                         .rss_key = NULL,
55                         .rss_key_len = 40,
56                         .rss_hf = 0,
57                 },
58         },
59         .txmode = {
60                 .mq_mode = ETH_MQ_TX_NONE,
61         },
62         .lpbk_mode = 0,
63 };
64
65 #define RETA_CONF_SIZE     (ETH_RSS_RETA_SIZE_512 / RTE_RETA_GROUP_SIZE)
66
67 static int
68 rss_setup(uint16_t port_id,
69         uint16_t reta_size,
70         struct link_params_rss *rss)
71 {
72         struct rte_eth_rss_reta_entry64 reta_conf[RETA_CONF_SIZE];
73         uint32_t i;
74         int status;
75
76         /* RETA setting */
77         memset(reta_conf, 0, sizeof(reta_conf));
78
79         for (i = 0; i < reta_size; i++)
80                 reta_conf[i / RTE_RETA_GROUP_SIZE].mask = UINT64_MAX;
81
82         for (i = 0; i < reta_size; i++) {
83                 uint32_t reta_id = i / RTE_RETA_GROUP_SIZE;
84                 uint32_t reta_pos = i % RTE_RETA_GROUP_SIZE;
85                 uint32_t rss_qs_pos = i % rss->n_queues;
86
87                 reta_conf[reta_id].reta[reta_pos] =
88                         (uint16_t) rss->queue_id[rss_qs_pos];
89         }
90
91         /* RETA update */
92         status = rte_eth_dev_rss_reta_update(port_id,
93                 reta_conf,
94                 reta_size);
95
96         return status;
97 }
98
99 struct link *
100 link_create(const char *name, struct link_params *params)
101 {
102         struct rte_eth_dev_info port_info;
103         struct rte_eth_conf port_conf;
104         struct link *link;
105         struct link_params_rss *rss;
106         struct mempool *mempool;
107         uint32_t cpu_id, i;
108         int status;
109         uint16_t port_id;
110
111         /* Check input params */
112         if ((name == NULL) ||
113                 link_find(name) ||
114                 (params == NULL) ||
115                 (params->rx.n_queues == 0) ||
116                 (params->rx.queue_size == 0) ||
117                 (params->tx.n_queues == 0) ||
118                 (params->tx.queue_size == 0))
119                 return NULL;
120
121         port_id = params->port_id;
122         if (params->dev_name) {
123                 status = rte_eth_dev_get_port_by_name(params->dev_name,
124                         &port_id);
125
126                 if (status)
127                         return NULL;
128         } else
129                 if (!rte_eth_dev_is_valid_port(port_id))
130                         return NULL;
131
132         if (rte_eth_dev_info_get(port_id, &port_info) != 0)
133                 return NULL;
134
135         mempool = mempool_find(params->rx.mempool_name);
136         if (mempool == NULL)
137                 return NULL;
138
139         rss = params->rx.rss;
140         if (rss) {
141                 if ((port_info.reta_size == 0) ||
142                         (port_info.reta_size > ETH_RSS_RETA_SIZE_512))
143                         return NULL;
144
145                 if ((rss->n_queues == 0) ||
146                         (rss->n_queues >= LINK_RXQ_RSS_MAX))
147                         return NULL;
148
149                 for (i = 0; i < rss->n_queues; i++)
150                         if (rss->queue_id[i] >= port_info.max_rx_queues)
151                                 return NULL;
152         }
153
154         /**
155          * Resource create
156          */
157         /* Port */
158         memcpy(&port_conf, &port_conf_default, sizeof(port_conf));
159         if (rss) {
160                 port_conf.rxmode.mq_mode = ETH_MQ_RX_RSS;
161                 port_conf.rx_adv_conf.rss_conf.rss_hf =
162                         (ETH_RSS_IP | ETH_RSS_TCP | ETH_RSS_UDP) &
163                         port_info.flow_type_rss_offloads;
164         }
165
166         cpu_id = (uint32_t) rte_eth_dev_socket_id(port_id);
167         if (cpu_id == (uint32_t) SOCKET_ID_ANY)
168                 cpu_id = 0;
169
170         status = rte_eth_dev_configure(
171                 port_id,
172                 params->rx.n_queues,
173                 params->tx.n_queues,
174                 &port_conf);
175
176         if (status < 0)
177                 return NULL;
178
179         if (params->promiscuous) {
180                 status = rte_eth_promiscuous_enable(port_id);
181                 if (status != 0)
182                         return NULL;
183         }
184
185         /* Port RX */
186         for (i = 0; i < params->rx.n_queues; i++) {
187                 status = rte_eth_rx_queue_setup(
188                         port_id,
189                         i,
190                         params->rx.queue_size,
191                         cpu_id,
192                         NULL,
193                         mempool->m);
194
195                 if (status < 0)
196                         return NULL;
197         }
198
199         /* Port TX */
200         for (i = 0; i < params->tx.n_queues; i++) {
201                 status = rte_eth_tx_queue_setup(
202                         port_id,
203                         i,
204                         params->tx.queue_size,
205                         cpu_id,
206                         NULL);
207
208                 if (status < 0)
209                         return NULL;
210         }
211
212         /* Port start */
213         status = rte_eth_dev_start(port_id);
214         if (status < 0)
215                 return NULL;
216
217         if (rss) {
218                 status = rss_setup(port_id, port_info.reta_size, rss);
219
220                 if (status) {
221                         rte_eth_dev_stop(port_id);
222                         return NULL;
223                 }
224         }
225
226         /* Port link up */
227         status = rte_eth_dev_set_link_up(port_id);
228         if ((status < 0) && (status != -ENOTSUP)) {
229                 rte_eth_dev_stop(port_id);
230                 return NULL;
231         }
232
233         /* Node allocation */
234         link = calloc(1, sizeof(struct link));
235         if (link == NULL) {
236                 rte_eth_dev_stop(port_id);
237                 return NULL;
238         }
239
240         /* Node fill in */
241         strlcpy(link->name, name, sizeof(link->name));
242         link->port_id = port_id;
243         link->n_rxq = params->rx.n_queues;
244         link->n_txq = params->tx.n_queues;
245
246         /* Node add to list */
247         TAILQ_INSERT_TAIL(&link_list, link, node);
248
249         return link;
250 }
251
252 int
253 link_is_up(const char *name)
254 {
255         struct rte_eth_link link_params;
256         struct link *link;
257
258         /* Check input params */
259         if (name == NULL)
260                 return 0;
261
262         link = link_find(name);
263         if (link == NULL)
264                 return 0;
265
266         /* Resource */
267         if (rte_eth_link_get(link->port_id, &link_params) < 0)
268                 return 0;
269
270         return (link_params.link_status == ETH_LINK_DOWN) ? 0 : 1;
271 }