1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(C) 2019 Marvell International Ltd.
3  */
4 
5 #include <stdbool.h>
6 #include <getopt.h>
7 
8 #include <rte_cycles.h>
9 #include <rte_ethdev.h>
10 #include <rte_eventdev.h>
11 #include <rte_event_eth_rx_adapter.h>
12 #include <rte_event_eth_tx_adapter.h>
13 #include <rte_lcore.h>
14 #include <rte_spinlock.h>
15 
16 #include "l2fwd_common.h"
17 #include "l2fwd_event.h"
18 
19 static uint32_t
l2fwd_event_device_setup_generic(struct l2fwd_resources * rsrc)20 l2fwd_event_device_setup_generic(struct l2fwd_resources *rsrc)
21 {
22 	struct l2fwd_event_resources *evt_rsrc = rsrc->evt_rsrc;
23 	struct rte_event_dev_config event_d_conf = {
24 		.nb_events_limit  = 4096,
25 		.nb_event_queue_flows = 1024,
26 		.nb_event_port_dequeue_depth = 128,
27 		.nb_event_port_enqueue_depth = 128
28 	};
29 	struct rte_event_dev_info dev_info;
30 	const uint8_t event_d_id = 0; /* Always use first event device only */
31 	uint32_t event_queue_cfg = 0;
32 	uint16_t ethdev_count = 0;
33 	uint16_t num_workers = 0;
34 	uint16_t port_id;
35 	int ret;
36 
37 	RTE_ETH_FOREACH_DEV(port_id) {
38 		if ((rsrc->enabled_port_mask & (1 << port_id)) == 0)
39 			continue;
40 		ethdev_count++;
41 	}
42 
43 	/* Event device configurtion */
44 	rte_event_dev_info_get(event_d_id, &dev_info);
45 
46 	/* Enable implicit release */
47 	if (dev_info.event_dev_cap & RTE_EVENT_DEV_CAP_IMPLICIT_RELEASE_DISABLE)
48 		evt_rsrc->disable_implicit_release = 0;
49 
50 	if (dev_info.event_dev_cap & RTE_EVENT_DEV_CAP_QUEUE_ALL_TYPES)
51 		event_queue_cfg |= RTE_EVENT_QUEUE_CFG_ALL_TYPES;
52 
53 	/* One queue for each ethdev port + one Tx adapter Single link queue. */
54 	event_d_conf.nb_event_queues = ethdev_count + 1;
55 	if (dev_info.max_event_queues < event_d_conf.nb_event_queues)
56 		event_d_conf.nb_event_queues = dev_info.max_event_queues;
57 
58 	if (dev_info.max_num_events < event_d_conf.nb_events_limit)
59 		event_d_conf.nb_events_limit = dev_info.max_num_events;
60 
61 	if (dev_info.max_event_queue_flows < event_d_conf.nb_event_queue_flows)
62 		event_d_conf.nb_event_queue_flows =
63 						dev_info.max_event_queue_flows;
64 
65 	if (dev_info.max_event_port_dequeue_depth <
66 				event_d_conf.nb_event_port_dequeue_depth)
67 		event_d_conf.nb_event_port_dequeue_depth =
68 				dev_info.max_event_port_dequeue_depth;
69 
70 	if (dev_info.max_event_port_enqueue_depth <
71 				event_d_conf.nb_event_port_enqueue_depth)
72 		event_d_conf.nb_event_port_enqueue_depth =
73 				dev_info.max_event_port_enqueue_depth;
74 
75 	/* Ignore Main core and service cores. */
76 	num_workers = rte_lcore_count() - 1 - rte_service_lcore_count();
77 	if (dev_info.max_event_ports < num_workers)
78 		num_workers = dev_info.max_event_ports;
79 
80 	event_d_conf.nb_event_ports = num_workers;
81 	evt_rsrc->evp.nb_ports = num_workers;
82 	evt_rsrc->evq.nb_queues = event_d_conf.nb_event_queues;
83 
84 	evt_rsrc->has_burst = !!(dev_info.event_dev_cap &
85 				    RTE_EVENT_DEV_CAP_BURST_MODE);
86 
87 	ret = rte_event_dev_configure(event_d_id, &event_d_conf);
88 	if (ret < 0)
89 		rte_panic("Error in configuring event device\n");
90 
91 	evt_rsrc->event_d_id = event_d_id;
92 	return event_queue_cfg;
93 }
94 
95 static void
l2fwd_event_port_setup_generic(struct l2fwd_resources * rsrc)96 l2fwd_event_port_setup_generic(struct l2fwd_resources *rsrc)
97 {
98 	struct l2fwd_event_resources *evt_rsrc = rsrc->evt_rsrc;
99 	uint8_t event_d_id = evt_rsrc->event_d_id;
100 	struct rte_event_port_conf event_p_conf = {
101 		.dequeue_depth = 32,
102 		.enqueue_depth = 32,
103 		.new_event_threshold = 4096
104 	};
105 	struct rte_event_port_conf def_p_conf;
106 	uint8_t event_p_id;
107 	int32_t ret;
108 
109 	evt_rsrc->evp.event_p_id = (uint8_t *)malloc(sizeof(uint8_t) *
110 					evt_rsrc->evp.nb_ports);
111 	if (!evt_rsrc->evp.event_p_id)
112 		rte_panic("No space is available\n");
113 
114 	memset(&def_p_conf, 0, sizeof(struct rte_event_port_conf));
115 	ret = rte_event_port_default_conf_get(event_d_id, 0, &def_p_conf);
116 	if (ret < 0)
117 		rte_panic("Error to get default configuration of event port\n");
118 
119 	if (def_p_conf.new_event_threshold < event_p_conf.new_event_threshold)
120 		event_p_conf.new_event_threshold =
121 			def_p_conf.new_event_threshold;
122 
123 	if (def_p_conf.dequeue_depth < event_p_conf.dequeue_depth)
124 		event_p_conf.dequeue_depth = def_p_conf.dequeue_depth;
125 
126 	if (def_p_conf.enqueue_depth < event_p_conf.enqueue_depth)
127 		event_p_conf.enqueue_depth = def_p_conf.enqueue_depth;
128 
129 	event_p_conf.event_port_cfg = 0;
130 	if (evt_rsrc->disable_implicit_release)
131 		event_p_conf.event_port_cfg |=
132 			RTE_EVENT_PORT_CFG_DISABLE_IMPL_REL;
133 
134 	evt_rsrc->deq_depth = def_p_conf.dequeue_depth;
135 
136 	for (event_p_id = 0; event_p_id < evt_rsrc->evp.nb_ports;
137 								event_p_id++) {
138 		ret = rte_event_port_setup(event_d_id, event_p_id,
139 					   &event_p_conf);
140 		if (ret < 0)
141 			rte_panic("Error in configuring event port %d\n",
142 				  event_p_id);
143 
144 		ret = rte_event_port_link(event_d_id, event_p_id,
145 					  evt_rsrc->evq.event_q_id,
146 					  NULL,
147 					  evt_rsrc->evq.nb_queues - 1);
148 		if (ret != (evt_rsrc->evq.nb_queues - 1))
149 			rte_panic("Error in linking event port %d to queues\n",
150 				  event_p_id);
151 		evt_rsrc->evp.event_p_id[event_p_id] = event_p_id;
152 	}
153 	/* init spinlock */
154 	rte_spinlock_init(&evt_rsrc->evp.lock);
155 
156 	evt_rsrc->def_p_conf = event_p_conf;
157 }
158 
159 static void
l2fwd_event_queue_setup_generic(struct l2fwd_resources * rsrc,uint32_t event_queue_cfg)160 l2fwd_event_queue_setup_generic(struct l2fwd_resources *rsrc,
161 			  uint32_t event_queue_cfg)
162 {
163 	struct l2fwd_event_resources *evt_rsrc = rsrc->evt_rsrc;
164 	uint8_t event_d_id = evt_rsrc->event_d_id;
165 	struct rte_event_queue_conf event_q_conf = {
166 		.nb_atomic_flows = 1024,
167 		.nb_atomic_order_sequences = 1024,
168 		.event_queue_cfg = event_queue_cfg,
169 		.priority = RTE_EVENT_DEV_PRIORITY_NORMAL
170 	};
171 	struct rte_event_queue_conf def_q_conf;
172 	uint8_t event_q_id;
173 	int32_t ret;
174 
175 	event_q_conf.schedule_type = rsrc->sched_type;
176 	evt_rsrc->evq.event_q_id = (uint8_t *)malloc(sizeof(uint8_t) *
177 					evt_rsrc->evq.nb_queues);
178 	if (!evt_rsrc->evq.event_q_id)
179 		rte_panic("Memory allocation failure\n");
180 
181 	ret = rte_event_queue_default_conf_get(event_d_id, 0, &def_q_conf);
182 	if (ret < 0)
183 		rte_panic("Error to get default config of event queue\n");
184 
185 	if (def_q_conf.nb_atomic_flows < event_q_conf.nb_atomic_flows)
186 		event_q_conf.nb_atomic_flows = def_q_conf.nb_atomic_flows;
187 
188 	for (event_q_id = 0; event_q_id < (evt_rsrc->evq.nb_queues - 1);
189 								event_q_id++) {
190 		ret = rte_event_queue_setup(event_d_id, event_q_id,
191 					    &event_q_conf);
192 		if (ret < 0)
193 			rte_panic("Error in configuring event queue\n");
194 		evt_rsrc->evq.event_q_id[event_q_id] = event_q_id;
195 	}
196 
197 	event_q_conf.event_queue_cfg |= RTE_EVENT_QUEUE_CFG_SINGLE_LINK;
198 	event_q_conf.priority = RTE_EVENT_DEV_PRIORITY_HIGHEST,
199 	ret = rte_event_queue_setup(event_d_id, event_q_id, &event_q_conf);
200 	if (ret < 0)
201 		rte_panic("Error in configuring event queue for Tx adapter\n");
202 	evt_rsrc->evq.event_q_id[event_q_id] = event_q_id;
203 }
204 
205 static void
l2fwd_rx_tx_adapter_setup_generic(struct l2fwd_resources * rsrc)206 l2fwd_rx_tx_adapter_setup_generic(struct l2fwd_resources *rsrc)
207 {
208 	struct l2fwd_event_resources *evt_rsrc = rsrc->evt_rsrc;
209 	struct rte_event_eth_rx_adapter_queue_conf eth_q_conf;
210 	uint8_t event_d_id = evt_rsrc->event_d_id;
211 	uint8_t rx_adptr_id = 0;
212 	uint8_t tx_adptr_id = 0;
213 	uint8_t tx_port_id = 0;
214 	uint16_t port_id;
215 	uint32_t service_id;
216 	int32_t ret, i = 0;
217 
218 	memset(&eth_q_conf, 0, sizeof(eth_q_conf));
219 	eth_q_conf.ev.priority = RTE_EVENT_DEV_PRIORITY_NORMAL;
220 
221 	/* Rx adapter setup */
222 	evt_rsrc->rx_adptr.nb_rx_adptr = 1;
223 	evt_rsrc->rx_adptr.rx_adptr = (uint8_t *)malloc(sizeof(uint8_t) *
224 					evt_rsrc->rx_adptr.nb_rx_adptr);
225 	if (!evt_rsrc->rx_adptr.rx_adptr) {
226 		free(evt_rsrc->evp.event_p_id);
227 		free(evt_rsrc->evq.event_q_id);
228 		rte_panic("Failed to allocate memery for Rx adapter\n");
229 	}
230 
231 	ret = rte_event_eth_rx_adapter_create(rx_adptr_id, event_d_id,
232 					      &evt_rsrc->def_p_conf);
233 	if (ret)
234 		rte_panic("Failed to create rx adapter\n");
235 
236 	/* Configure user requested sched type */
237 	eth_q_conf.ev.sched_type = rsrc->sched_type;
238 	RTE_ETH_FOREACH_DEV(port_id) {
239 		if ((rsrc->enabled_port_mask & (1 << port_id)) == 0)
240 			continue;
241 		eth_q_conf.ev.queue_id = evt_rsrc->evq.event_q_id[i];
242 		ret = rte_event_eth_rx_adapter_queue_add(rx_adptr_id, port_id,
243 							 -1, &eth_q_conf);
244 		if (ret)
245 			rte_panic("Failed to add queues to Rx adapter\n");
246 		if (i < evt_rsrc->evq.nb_queues)
247 			i++;
248 	}
249 
250 	ret = rte_event_eth_rx_adapter_service_id_get(rx_adptr_id, &service_id);
251 	if (ret != -ESRCH && ret != 0)
252 		rte_panic("Error getting the service ID for rx adptr\n");
253 
254 	rte_service_runstate_set(service_id, 1);
255 	rte_service_set_runstate_mapped_check(service_id, 0);
256 	evt_rsrc->rx_adptr.service_id = service_id;
257 
258 	ret = rte_event_eth_rx_adapter_start(rx_adptr_id);
259 	if (ret)
260 		rte_panic("Rx adapter[%d] start Failed\n", rx_adptr_id);
261 
262 	evt_rsrc->rx_adptr.rx_adptr[0] = rx_adptr_id;
263 
264 	/* Tx adapter setup */
265 	evt_rsrc->tx_adptr.nb_tx_adptr = 1;
266 	evt_rsrc->tx_adptr.tx_adptr = (uint8_t *)malloc(sizeof(uint8_t) *
267 					evt_rsrc->tx_adptr.nb_tx_adptr);
268 	if (!evt_rsrc->tx_adptr.tx_adptr) {
269 		free(evt_rsrc->rx_adptr.rx_adptr);
270 		free(evt_rsrc->evp.event_p_id);
271 		free(evt_rsrc->evq.event_q_id);
272 		rte_panic("Failed to allocate memery for Rx adapter\n");
273 	}
274 
275 	ret = rte_event_eth_tx_adapter_create(tx_adptr_id, event_d_id,
276 					      &evt_rsrc->def_p_conf);
277 	if (ret)
278 		rte_panic("Failed to create tx adapter\n");
279 
280 	RTE_ETH_FOREACH_DEV(port_id) {
281 		if ((rsrc->enabled_port_mask & (1 << port_id)) == 0)
282 			continue;
283 		ret = rte_event_eth_tx_adapter_queue_add(tx_adptr_id, port_id,
284 							 -1);
285 		if (ret)
286 			rte_panic("Failed to add queues to Tx adapter\n");
287 	}
288 
289 	ret = rte_event_eth_tx_adapter_service_id_get(tx_adptr_id, &service_id);
290 	if (ret != -ESRCH && ret != 0)
291 		rte_panic("Failed to get Tx adapter service ID\n");
292 
293 	rte_service_runstate_set(service_id, 1);
294 	rte_service_set_runstate_mapped_check(service_id, 0);
295 	evt_rsrc->tx_adptr.service_id = service_id;
296 
297 	ret = rte_event_eth_tx_adapter_event_port_get(tx_adptr_id, &tx_port_id);
298 	if (ret)
299 		rte_panic("Failed to get Tx adapter port id: %d\n", ret);
300 
301 	ret = rte_event_port_link(event_d_id, tx_port_id,
302 				  &evt_rsrc->evq.event_q_id[
303 					evt_rsrc->evq.nb_queues - 1],
304 				  NULL, 1);
305 	if (ret != 1)
306 		rte_panic("Unable to link Tx adapter port to Tx queue:err=%d\n",
307 			 ret);
308 
309 	ret = rte_event_eth_tx_adapter_start(tx_adptr_id);
310 	if (ret)
311 		rte_panic("Tx adapter[%d] start Failed\n", tx_adptr_id);
312 
313 	evt_rsrc->tx_adptr.tx_adptr[0] = tx_adptr_id;
314 }
315 
316 void
l2fwd_event_set_generic_ops(struct event_setup_ops * ops)317 l2fwd_event_set_generic_ops(struct event_setup_ops *ops)
318 {
319 	ops->event_device_setup = l2fwd_event_device_setup_generic;
320 	ops->event_queue_setup = l2fwd_event_queue_setup_generic;
321 	ops->event_port_setup = l2fwd_event_port_setup_generic;
322 	ops->adapter_setup = l2fwd_rx_tx_adapter_setup_generic;
323 }
324