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
link_init(void)17 link_init(void)
18 {
19 TAILQ_INIT(&link_list);
20
21 return 0;
22 }
23
24 struct link *
link_find(const char * name)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 *
link_next(struct link * 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
rss_setup(uint16_t port_id,uint16_t reta_size,struct link_params_rss * rss)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 *
link_create(const char * name,struct link_params * params)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
link_is_up(const char * name)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 }
272