1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2017 Intel Corporation
3  */
4 
5 #include <stdint.h>
6 #include <stdlib.h>
7 #include <string.h>
8 
9 #include <rte_ethdev_driver.h>
10 #include <rte_ethdev_vdev.h>
11 #include <rte_malloc.h>
12 #include <rte_bus_vdev.h>
13 #include <rte_kvargs.h>
14 #include <rte_errno.h>
15 #include <rte_ring.h>
16 #include <rte_tm_driver.h>
17 #include <rte_mtr_driver.h>
18 
19 #include "rte_eth_softnic.h"
20 #include "rte_eth_softnic_internals.h"
21 
22 #define PMD_PARAM_FIRMWARE                                 "firmware"
23 #define PMD_PARAM_CONN_PORT                                "conn_port"
24 #define PMD_PARAM_CPU_ID                                   "cpu_id"
25 #define PMD_PARAM_SC                                       "sc"
26 #define PMD_PARAM_TM_N_QUEUES                              "tm_n_queues"
27 #define PMD_PARAM_TM_QSIZE0                                "tm_qsize0"
28 #define PMD_PARAM_TM_QSIZE1                                "tm_qsize1"
29 #define PMD_PARAM_TM_QSIZE2                                "tm_qsize2"
30 #define PMD_PARAM_TM_QSIZE3                                "tm_qsize3"
31 #define PMD_PARAM_TM_QSIZE4                                "tm_qsize4"
32 #define PMD_PARAM_TM_QSIZE5                                "tm_qsize5"
33 #define PMD_PARAM_TM_QSIZE6                                "tm_qsize6"
34 #define PMD_PARAM_TM_QSIZE7                                "tm_qsize7"
35 #define PMD_PARAM_TM_QSIZE8                                "tm_qsize8"
36 #define PMD_PARAM_TM_QSIZE9                                "tm_qsize9"
37 #define PMD_PARAM_TM_QSIZE10                               "tm_qsize10"
38 #define PMD_PARAM_TM_QSIZE11                               "tm_qsize11"
39 #define PMD_PARAM_TM_QSIZE12                               "tm_qsize12"
40 
41 
42 static const char * const pmd_valid_args[] = {
43 	PMD_PARAM_FIRMWARE,
44 	PMD_PARAM_CONN_PORT,
45 	PMD_PARAM_CPU_ID,
46 	PMD_PARAM_SC,
47 	PMD_PARAM_TM_N_QUEUES,
48 	PMD_PARAM_TM_QSIZE0,
49 	PMD_PARAM_TM_QSIZE1,
50 	PMD_PARAM_TM_QSIZE2,
51 	PMD_PARAM_TM_QSIZE3,
52 	PMD_PARAM_TM_QSIZE4,
53 	PMD_PARAM_TM_QSIZE5,
54 	PMD_PARAM_TM_QSIZE6,
55 	PMD_PARAM_TM_QSIZE7,
56 	PMD_PARAM_TM_QSIZE8,
57 	PMD_PARAM_TM_QSIZE9,
58 	PMD_PARAM_TM_QSIZE10,
59 	PMD_PARAM_TM_QSIZE11,
60 	PMD_PARAM_TM_QSIZE12,
61 	NULL
62 };
63 
64 static const char welcome[] =
65 	"\n"
66 	"Welcome to Soft NIC!\n"
67 	"\n";
68 
69 static const char prompt[] = "softnic> ";
70 
71 static const struct softnic_conn_params conn_params_default = {
72 	.welcome = welcome,
73 	.prompt = prompt,
74 	.addr = "0.0.0.0",
75 	.port = 0,
76 	.buf_size = 1024 * 1024,
77 	.msg_in_len_max = 1024,
78 	.msg_out_len_max = 1024 * 1024,
79 	.msg_handle = softnic_cli_process,
80 	.msg_handle_arg = NULL,
81 };
82 
83 RTE_LOG_REGISTER(pmd_softnic_logtype, pmd.net.softnic, NOTICE);
84 
85 #define PMD_LOG(level, fmt, args...) \
86 	rte_log(RTE_LOG_ ## level, pmd_softnic_logtype, \
87 		"%s(): " fmt "\n", __func__, ##args)
88 
89 static int
pmd_dev_infos_get(struct rte_eth_dev * dev __rte_unused,struct rte_eth_dev_info * dev_info)90 pmd_dev_infos_get(struct rte_eth_dev *dev __rte_unused,
91 	struct rte_eth_dev_info *dev_info)
92 {
93 	dev_info->max_rx_pktlen = UINT32_MAX;
94 	dev_info->max_rx_queues = UINT16_MAX;
95 	dev_info->max_tx_queues = UINT16_MAX;
96 
97 	return 0;
98 }
99 
100 static int
pmd_dev_configure(struct rte_eth_dev * dev __rte_unused)101 pmd_dev_configure(struct rte_eth_dev *dev __rte_unused)
102 {
103 	return 0;
104 }
105 
106 static int
pmd_rx_queue_setup(struct rte_eth_dev * dev,uint16_t rx_queue_id,uint16_t nb_rx_desc,unsigned int socket_id __rte_unused,const struct rte_eth_rxconf * rx_conf __rte_unused,struct rte_mempool * mb_pool __rte_unused)107 pmd_rx_queue_setup(struct rte_eth_dev *dev,
108 	uint16_t rx_queue_id,
109 	uint16_t nb_rx_desc,
110 	unsigned int socket_id __rte_unused,
111 	const struct rte_eth_rxconf *rx_conf __rte_unused,
112 	struct rte_mempool *mb_pool __rte_unused)
113 {
114 	char name[NAME_SIZE];
115 	struct pmd_internals *p = dev->data->dev_private;
116 	struct softnic_swq *swq;
117 
118 	struct softnic_swq_params params = {
119 		.size = nb_rx_desc,
120 	};
121 
122 	snprintf(name, sizeof(name), "RXQ%u", rx_queue_id);
123 
124 	swq = softnic_swq_create(p,
125 		name,
126 		&params);
127 	if (swq == NULL)
128 		return -1;
129 
130 	dev->data->rx_queues[rx_queue_id] = swq->r;
131 	return 0;
132 }
133 
134 static int
pmd_tx_queue_setup(struct rte_eth_dev * dev,uint16_t tx_queue_id,uint16_t nb_tx_desc,unsigned int socket_id __rte_unused,const struct rte_eth_txconf * tx_conf __rte_unused)135 pmd_tx_queue_setup(struct rte_eth_dev *dev,
136 	uint16_t tx_queue_id,
137 	uint16_t nb_tx_desc,
138 	unsigned int socket_id __rte_unused,
139 	const struct rte_eth_txconf *tx_conf __rte_unused)
140 {
141 	char name[NAME_SIZE];
142 	struct pmd_internals *p = dev->data->dev_private;
143 	struct softnic_swq *swq;
144 
145 	struct softnic_swq_params params = {
146 		.size = nb_tx_desc,
147 	};
148 
149 	snprintf(name, sizeof(name), "TXQ%u", tx_queue_id);
150 
151 	swq = softnic_swq_create(p,
152 		name,
153 		&params);
154 	if (swq == NULL)
155 		return -1;
156 
157 	dev->data->tx_queues[tx_queue_id] = swq->r;
158 	return 0;
159 }
160 
161 static int
pmd_dev_start(struct rte_eth_dev * dev)162 pmd_dev_start(struct rte_eth_dev *dev)
163 {
164 	struct pmd_internals *p = dev->data->dev_private;
165 	int status;
166 
167 	/* Firmware */
168 	status = softnic_cli_script_process(p,
169 		p->params.firmware,
170 		conn_params_default.msg_in_len_max,
171 		conn_params_default.msg_out_len_max);
172 	if (status)
173 		return status;
174 
175 	/* Link UP */
176 	dev->data->dev_link.link_status = ETH_LINK_UP;
177 
178 	return 0;
179 }
180 
181 static int
pmd_dev_stop(struct rte_eth_dev * dev)182 pmd_dev_stop(struct rte_eth_dev *dev)
183 {
184 	struct pmd_internals *p = dev->data->dev_private;
185 
186 	/* Link DOWN */
187 	dev->data->dev_link.link_status = ETH_LINK_DOWN;
188 
189 	/* Firmware */
190 	softnic_pipeline_disable_all(p);
191 	softnic_pipeline_free(p);
192 	softnic_table_action_profile_free(p);
193 	softnic_port_in_action_profile_free(p);
194 	softnic_tap_free(p);
195 	softnic_tmgr_free(p);
196 	softnic_link_free(p);
197 	softnic_softnic_swq_free_keep_rxq_txq(p);
198 	softnic_mempool_free(p);
199 
200 	tm_hierarchy_free(p);
201 	softnic_mtr_free(p);
202 
203 	return 0;
204 }
205 
206 static void
pmd_free(struct pmd_internals * p)207 pmd_free(struct pmd_internals *p)
208 {
209 	if (p == NULL)
210 		return;
211 
212 	if (p->params.conn_port)
213 		softnic_conn_free(p->conn);
214 
215 	softnic_thread_free(p);
216 	softnic_pipeline_free(p);
217 	softnic_table_action_profile_free(p);
218 	softnic_port_in_action_profile_free(p);
219 	softnic_tap_free(p);
220 	softnic_tmgr_free(p);
221 	softnic_link_free(p);
222 	softnic_swq_free(p);
223 	softnic_mempool_free(p);
224 
225 	tm_hierarchy_free(p);
226 	softnic_mtr_free(p);
227 
228 	rte_free(p);
229 }
230 
231 static int
pmd_dev_close(struct rte_eth_dev * dev)232 pmd_dev_close(struct rte_eth_dev *dev)
233 {
234 	if (rte_eal_process_type() != RTE_PROC_PRIMARY)
235 		return 0;
236 
237 	pmd_free(dev->data->dev_private);
238 	dev->data->dev_private = NULL; /* already freed */
239 	dev->data->mac_addrs = NULL; /* statically allocated */
240 	return 0;
241 }
242 
243 static int
pmd_link_update(struct rte_eth_dev * dev __rte_unused,int wait_to_complete __rte_unused)244 pmd_link_update(struct rte_eth_dev *dev __rte_unused,
245 	int wait_to_complete __rte_unused)
246 {
247 	return 0;
248 }
249 
250 static int
pmd_filter_ctrl(struct rte_eth_dev * dev __rte_unused,enum rte_filter_type filter_type,enum rte_filter_op filter_op,void * arg)251 pmd_filter_ctrl(struct rte_eth_dev *dev __rte_unused,
252 		enum rte_filter_type filter_type,
253 		enum rte_filter_op filter_op,
254 		void *arg)
255 {
256 	if (filter_type == RTE_ETH_FILTER_GENERIC &&
257 			filter_op == RTE_ETH_FILTER_GET) {
258 		*(const void **)arg = &pmd_flow_ops;
259 		return 0;
260 	}
261 
262 	return -ENOTSUP;
263 }
264 
265 static int
pmd_tm_ops_get(struct rte_eth_dev * dev __rte_unused,void * arg)266 pmd_tm_ops_get(struct rte_eth_dev *dev __rte_unused, void *arg)
267 {
268 	*(const struct rte_tm_ops **)arg = &pmd_tm_ops;
269 
270 	return 0;
271 }
272 
273 static int
pmd_mtr_ops_get(struct rte_eth_dev * dev __rte_unused,void * arg)274 pmd_mtr_ops_get(struct rte_eth_dev *dev __rte_unused, void *arg)
275 {
276 	*(const struct rte_mtr_ops **)arg = &pmd_mtr_ops;
277 
278 	return 0;
279 }
280 
281 static const struct eth_dev_ops pmd_ops = {
282 	.dev_configure = pmd_dev_configure,
283 	.dev_start = pmd_dev_start,
284 	.dev_stop = pmd_dev_stop,
285 	.dev_close = pmd_dev_close,
286 	.link_update = pmd_link_update,
287 	.dev_infos_get = pmd_dev_infos_get,
288 	.rx_queue_setup = pmd_rx_queue_setup,
289 	.tx_queue_setup = pmd_tx_queue_setup,
290 	.filter_ctrl = pmd_filter_ctrl,
291 	.tm_ops_get = pmd_tm_ops_get,
292 	.mtr_ops_get = pmd_mtr_ops_get,
293 };
294 
295 static uint16_t
pmd_rx_pkt_burst(void * rxq,struct rte_mbuf ** rx_pkts,uint16_t nb_pkts)296 pmd_rx_pkt_burst(void *rxq,
297 	struct rte_mbuf **rx_pkts,
298 	uint16_t nb_pkts)
299 {
300 	return (uint16_t)rte_ring_sc_dequeue_burst(rxq,
301 		(void **)rx_pkts,
302 		nb_pkts,
303 		NULL);
304 }
305 
306 static uint16_t
pmd_tx_pkt_burst(void * txq,struct rte_mbuf ** tx_pkts,uint16_t nb_pkts)307 pmd_tx_pkt_burst(void *txq,
308 	struct rte_mbuf **tx_pkts,
309 	uint16_t nb_pkts)
310 {
311 	return (uint16_t)rte_ring_sp_enqueue_burst(txq,
312 		(void **)tx_pkts,
313 		nb_pkts,
314 		NULL);
315 }
316 
317 static void *
pmd_init(struct pmd_params * params)318 pmd_init(struct pmd_params *params)
319 {
320 	struct pmd_internals *p;
321 	int status;
322 
323 	p = rte_zmalloc_socket(params->name,
324 		sizeof(struct pmd_internals),
325 		0,
326 		params->cpu_id);
327 	if (p == NULL)
328 		return NULL;
329 
330 	/* Params */
331 	memcpy(&p->params, params, sizeof(p->params));
332 
333 	/* Resources */
334 	tm_hierarchy_init(p);
335 	softnic_mtr_init(p);
336 
337 	softnic_mempool_init(p);
338 	softnic_swq_init(p);
339 	softnic_link_init(p);
340 	softnic_tmgr_init(p);
341 	softnic_tap_init(p);
342 	softnic_cryptodev_init(p);
343 	softnic_port_in_action_profile_init(p);
344 	softnic_table_action_profile_init(p);
345 	softnic_pipeline_init(p);
346 
347 	status = softnic_thread_init(p);
348 	if (status) {
349 		rte_free(p);
350 		return NULL;
351 	}
352 
353 	if (params->conn_port) {
354 		struct softnic_conn_params conn_params;
355 
356 		memcpy(&conn_params, &conn_params_default, sizeof(conn_params));
357 		conn_params.port = p->params.conn_port;
358 		conn_params.msg_handle_arg = p;
359 
360 		p->conn = softnic_conn_init(&conn_params);
361 		if (p->conn == NULL) {
362 			softnic_thread_free(p);
363 			rte_free(p);
364 			return NULL;
365 		}
366 	}
367 
368 	return p;
369 }
370 
371 static struct rte_ether_addr eth_addr = {
372 	.addr_bytes = {0},
373 };
374 
375 static int
pmd_ethdev_register(struct rte_vdev_device * vdev,struct pmd_params * params,void * dev_private)376 pmd_ethdev_register(struct rte_vdev_device *vdev,
377 	struct pmd_params *params,
378 	void *dev_private)
379 {
380 	struct rte_eth_dev *dev;
381 
382 	/* Ethdev entry allocation */
383 	dev = rte_eth_dev_allocate(params->name);
384 	if (!dev)
385 		return -ENOMEM;
386 
387 	/* dev */
388 	dev->rx_pkt_burst = pmd_rx_pkt_burst;
389 	dev->tx_pkt_burst = pmd_tx_pkt_burst;
390 	dev->tx_pkt_prepare = NULL;
391 	dev->dev_ops = &pmd_ops;
392 	dev->device = &vdev->device;
393 
394 	/* dev->data */
395 	dev->data->dev_private = dev_private;
396 	dev->data->dev_link.link_speed = ETH_SPEED_NUM_100G;
397 	dev->data->dev_link.link_duplex = ETH_LINK_FULL_DUPLEX;
398 	dev->data->dev_link.link_autoneg = ETH_LINK_FIXED;
399 	dev->data->dev_link.link_status = ETH_LINK_DOWN;
400 	dev->data->mac_addrs = &eth_addr;
401 	dev->data->promiscuous = 1;
402 	dev->data->numa_node = params->cpu_id;
403 
404 	rte_eth_dev_probing_finish(dev);
405 
406 	return 0;
407 }
408 
409 static int
get_string(const char * key __rte_unused,const char * value,void * extra_args)410 get_string(const char *key __rte_unused, const char *value, void *extra_args)
411 {
412 	if (!value || !extra_args)
413 		return -EINVAL;
414 
415 	*(char **)extra_args = strdup(value);
416 
417 	if (!*(char **)extra_args)
418 		return -ENOMEM;
419 
420 	return 0;
421 }
422 
423 static int
get_uint32(const char * key __rte_unused,const char * value,void * extra_args)424 get_uint32(const char *key __rte_unused, const char *value, void *extra_args)
425 {
426 	if (!value || !extra_args)
427 		return -EINVAL;
428 
429 	*(uint32_t *)extra_args = strtoull(value, NULL, 0);
430 
431 	return 0;
432 }
433 
434 static int
get_uint16(const char * key __rte_unused,const char * value,void * extra_args)435 get_uint16(const char *key __rte_unused, const char *value, void *extra_args)
436 {
437 	if (!value || !extra_args)
438 		return -EINVAL;
439 
440 	*(uint16_t *)extra_args = strtoull(value, NULL, 0);
441 
442 	return 0;
443 }
444 
445 static int
pmd_parse_args(struct pmd_params * p,const char * params)446 pmd_parse_args(struct pmd_params *p, const char *params)
447 {
448 	struct rte_kvargs *kvlist;
449 	int ret = 0;
450 
451 	kvlist = rte_kvargs_parse(params, pmd_valid_args);
452 	if (kvlist == NULL)
453 		return -EINVAL;
454 
455 	/* Set default values */
456 	memset(p, 0, sizeof(*p));
457 	p->firmware = SOFTNIC_FIRMWARE;
458 	p->cpu_id = SOFTNIC_CPU_ID;
459 	p->sc = SOFTNIC_SC;
460 	p->tm.n_queues = SOFTNIC_TM_N_QUEUES;
461 	p->tm.qsize[0] = SOFTNIC_TM_QUEUE_SIZE;
462 	p->tm.qsize[1] = SOFTNIC_TM_QUEUE_SIZE;
463 	p->tm.qsize[2] = SOFTNIC_TM_QUEUE_SIZE;
464 	p->tm.qsize[3] = SOFTNIC_TM_QUEUE_SIZE;
465 	p->tm.qsize[4] = SOFTNIC_TM_QUEUE_SIZE;
466 	p->tm.qsize[5] = SOFTNIC_TM_QUEUE_SIZE;
467 	p->tm.qsize[6] = SOFTNIC_TM_QUEUE_SIZE;
468 	p->tm.qsize[7] = SOFTNIC_TM_QUEUE_SIZE;
469 	p->tm.qsize[8] = SOFTNIC_TM_QUEUE_SIZE;
470 	p->tm.qsize[9] = SOFTNIC_TM_QUEUE_SIZE;
471 	p->tm.qsize[10] = SOFTNIC_TM_QUEUE_SIZE;
472 	p->tm.qsize[11] = SOFTNIC_TM_QUEUE_SIZE;
473 	p->tm.qsize[12] = SOFTNIC_TM_QUEUE_SIZE;
474 
475 	/* Firmware script (optional) */
476 	if (rte_kvargs_count(kvlist, PMD_PARAM_FIRMWARE) == 1) {
477 		ret = rte_kvargs_process(kvlist, PMD_PARAM_FIRMWARE,
478 			&get_string, &p->firmware);
479 		if (ret < 0)
480 			goto out_free;
481 	}
482 
483 	/* Connection listening port (optional) */
484 	if (rte_kvargs_count(kvlist, PMD_PARAM_CONN_PORT) == 1) {
485 		ret = rte_kvargs_process(kvlist, PMD_PARAM_CONN_PORT,
486 			&get_uint16, &p->conn_port);
487 		if (ret < 0)
488 			goto out_free;
489 	}
490 
491 	/* CPU ID (optional) */
492 	if (rte_kvargs_count(kvlist, PMD_PARAM_CPU_ID) == 1) {
493 		ret = rte_kvargs_process(kvlist, PMD_PARAM_CPU_ID,
494 			&get_uint32, &p->cpu_id);
495 		if (ret < 0)
496 			goto out_free;
497 	}
498 
499 	/* Service cores (optional) */
500 	if (rte_kvargs_count(kvlist, PMD_PARAM_SC) == 1) {
501 		ret = rte_kvargs_process(kvlist, PMD_PARAM_SC,
502 			&get_uint32, &p->sc);
503 		if (ret < 0)
504 			goto out_free;
505 	}
506 
507 	/* TM number of queues (optional) */
508 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_N_QUEUES) == 1) {
509 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_N_QUEUES,
510 			&get_uint32, &p->tm.n_queues);
511 		if (ret < 0)
512 			goto out_free;
513 	}
514 
515 	/* TM queue size 0 .. 3 (optional) */
516 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_QSIZE0) == 1) {
517 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_QSIZE0,
518 			&get_uint32, &p->tm.qsize[0]);
519 		if (ret < 0)
520 			goto out_free;
521 	}
522 
523 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_QSIZE1) == 1) {
524 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_QSIZE1,
525 			&get_uint32, &p->tm.qsize[1]);
526 		if (ret < 0)
527 			goto out_free;
528 	}
529 
530 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_QSIZE2) == 1) {
531 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_QSIZE2,
532 			&get_uint32, &p->tm.qsize[2]);
533 		if (ret < 0)
534 			goto out_free;
535 	}
536 
537 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_QSIZE3) == 1) {
538 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_QSIZE3,
539 			&get_uint32, &p->tm.qsize[3]);
540 		if (ret < 0)
541 			goto out_free;
542 	}
543 
544 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_QSIZE4) == 1) {
545 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_QSIZE4,
546 			&get_uint32, &p->tm.qsize[4]);
547 		if (ret < 0)
548 			goto out_free;
549 	}
550 
551 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_QSIZE5) == 1) {
552 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_QSIZE5,
553 			&get_uint32, &p->tm.qsize[5]);
554 		if (ret < 0)
555 			goto out_free;
556 	}
557 
558 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_QSIZE6) == 1) {
559 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_QSIZE6,
560 			&get_uint32, &p->tm.qsize[6]);
561 		if (ret < 0)
562 			goto out_free;
563 	}
564 
565 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_QSIZE7) == 1) {
566 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_QSIZE7,
567 			&get_uint32, &p->tm.qsize[7]);
568 		if (ret < 0)
569 			goto out_free;
570 	}
571 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_QSIZE8) == 1) {
572 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_QSIZE8,
573 			&get_uint32, &p->tm.qsize[8]);
574 		if (ret < 0)
575 			goto out_free;
576 	}
577 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_QSIZE9) == 1) {
578 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_QSIZE9,
579 			&get_uint32, &p->tm.qsize[9]);
580 		if (ret < 0)
581 			goto out_free;
582 	}
583 
584 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_QSIZE10) == 1) {
585 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_QSIZE10,
586 			&get_uint32, &p->tm.qsize[10]);
587 		if (ret < 0)
588 			goto out_free;
589 	}
590 
591 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_QSIZE11) == 1) {
592 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_QSIZE11,
593 			&get_uint32, &p->tm.qsize[11]);
594 		if (ret < 0)
595 			goto out_free;
596 	}
597 
598 	if (rte_kvargs_count(kvlist, PMD_PARAM_TM_QSIZE12) == 1) {
599 		ret = rte_kvargs_process(kvlist, PMD_PARAM_TM_QSIZE12,
600 			&get_uint32, &p->tm.qsize[12]);
601 		if (ret < 0)
602 			goto out_free;
603 	}
604 
605 out_free:
606 	rte_kvargs_free(kvlist);
607 	return ret;
608 }
609 
610 static int
pmd_probe(struct rte_vdev_device * vdev)611 pmd_probe(struct rte_vdev_device *vdev)
612 {
613 	struct pmd_params p;
614 	const char *params;
615 	int status = 0;
616 
617 	void *dev_private;
618 	const char *name = rte_vdev_device_name(vdev);
619 
620 	PMD_LOG(INFO, "Probing device \"%s\"", name);
621 
622 	/* Parse input arguments */
623 	params = rte_vdev_device_args(vdev);
624 	if (!params)
625 		return -EINVAL;
626 
627 	status = pmd_parse_args(&p, params);
628 	if (status)
629 		return status;
630 
631 	p.name = name;
632 
633 	/* Allocate and initialize soft ethdev private data */
634 	dev_private = pmd_init(&p);
635 	if (dev_private == NULL)
636 		return -ENOMEM;
637 
638 	/* Register soft ethdev */
639 	PMD_LOG(INFO, "Creating soft ethdev \"%s\"", p.name);
640 
641 	status = pmd_ethdev_register(vdev, &p, dev_private);
642 	if (status) {
643 		pmd_free(dev_private);
644 		return status;
645 	}
646 
647 	return 0;
648 }
649 
650 static int
pmd_remove(struct rte_vdev_device * vdev)651 pmd_remove(struct rte_vdev_device *vdev)
652 {
653 	struct rte_eth_dev *dev = NULL;
654 
655 	if (!vdev)
656 		return -EINVAL;
657 
658 	PMD_LOG(INFO, "Removing device \"%s\"", rte_vdev_device_name(vdev));
659 
660 	/* Find the ethdev entry */
661 	dev = rte_eth_dev_allocated(rte_vdev_device_name(vdev));
662 	if (dev == NULL)
663 		return 0; /* port already released */
664 
665 	pmd_dev_close(dev);
666 	rte_eth_dev_release_port(dev);
667 
668 	return 0;
669 }
670 
671 static struct rte_vdev_driver pmd_softnic_drv = {
672 	.probe = pmd_probe,
673 	.remove = pmd_remove,
674 };
675 
676 RTE_PMD_REGISTER_VDEV(net_softnic, pmd_softnic_drv);
677 RTE_PMD_REGISTER_PARAM_STRING(net_softnic,
678 	PMD_PARAM_FIRMWARE "=<string> "
679 	PMD_PARAM_CONN_PORT "=<uint16> "
680 	PMD_PARAM_CPU_ID "=<uint32> "
681 	PMD_PARAM_TM_N_QUEUES "=<uint32> "
682 	PMD_PARAM_TM_QSIZE0 "=<uint32> "
683 	PMD_PARAM_TM_QSIZE1 "=<uint32> "
684 	PMD_PARAM_TM_QSIZE2 "=<uint32> "
685 	PMD_PARAM_TM_QSIZE3 "=<uint32>"
686 	PMD_PARAM_TM_QSIZE4 "=<uint32> "
687 	PMD_PARAM_TM_QSIZE5 "=<uint32> "
688 	PMD_PARAM_TM_QSIZE6 "=<uint32> "
689 	PMD_PARAM_TM_QSIZE7 "=<uint32> "
690 	PMD_PARAM_TM_QSIZE8 "=<uint32> "
691 	PMD_PARAM_TM_QSIZE9 "=<uint32> "
692 	PMD_PARAM_TM_QSIZE10 "=<uint32> "
693 	PMD_PARAM_TM_QSIZE11 "=<uint32>"
694 	PMD_PARAM_TM_QSIZE12 "=<uint32>"
695 );
696 
697 int
rte_pmd_softnic_manage(uint16_t port_id)698 rte_pmd_softnic_manage(uint16_t port_id)
699 {
700 	struct rte_eth_dev *dev = &rte_eth_devices[port_id];
701 	struct pmd_internals *softnic;
702 
703 #ifdef RTE_LIBRTE_ETHDEV_DEBUG
704 	RTE_ETH_VALID_PORTID_OR_ERR_RET(port_id, 0);
705 #endif
706 
707 	softnic = dev->data->dev_private;
708 
709 	softnic_conn_poll_for_conn(softnic->conn);
710 
711 	softnic_conn_poll_for_msg(softnic->conn);
712 
713 	return 0;
714 }
715