aa365a57de93b69d6f8279a980a5b7f0f2f35170
[dpdk.git] / drivers / net / kni / rte_eth_kni.c
1 /* SPDX-License-Identifier: BSD-3-Clause
2  * Copyright(c) 2017 Intel Corporation
3  */
4
5 #include <fcntl.h>
6 #include <pthread.h>
7 #include <unistd.h>
8
9 #include <rte_string_fns.h>
10 #include <rte_ethdev_driver.h>
11 #include <rte_ethdev_vdev.h>
12 #include <rte_kni.h>
13 #include <rte_kvargs.h>
14 #include <rte_malloc.h>
15 #include <rte_bus_vdev.h>
16
17 /* Only single queue supported */
18 #define KNI_MAX_QUEUE_PER_PORT 1
19
20 #define MAX_KNI_PORTS 8
21
22 #define KNI_ETHER_MTU(mbuf_size)       \
23         ((mbuf_size) - RTE_ETHER_HDR_LEN) /**< Ethernet MTU. */
24
25 #define ETH_KNI_NO_REQUEST_THREAD_ARG   "no_request_thread"
26 static const char * const valid_arguments[] = {
27         ETH_KNI_NO_REQUEST_THREAD_ARG,
28         NULL
29 };
30
31 struct eth_kni_args {
32         int no_request_thread;
33 };
34
35 struct pmd_queue_stats {
36         uint64_t pkts;
37         uint64_t bytes;
38 };
39
40 struct pmd_queue {
41         struct pmd_internals *internals;
42         struct rte_mempool *mb_pool;
43
44         struct pmd_queue_stats rx;
45         struct pmd_queue_stats tx;
46 };
47
48 struct pmd_internals {
49         struct rte_kni *kni;
50         uint16_t port_id;
51         int is_kni_started;
52
53         pthread_t thread;
54         int stop_thread;
55         int no_request_thread;
56
57         struct rte_ether_addr eth_addr;
58
59         struct pmd_queue rx_queues[KNI_MAX_QUEUE_PER_PORT];
60         struct pmd_queue tx_queues[KNI_MAX_QUEUE_PER_PORT];
61 };
62
63 static const struct rte_eth_link pmd_link = {
64                 .link_speed = ETH_SPEED_NUM_10G,
65                 .link_duplex = ETH_LINK_FULL_DUPLEX,
66                 .link_status = ETH_LINK_DOWN,
67                 .link_autoneg = ETH_LINK_FIXED,
68 };
69 static int is_kni_initialized;
70
71 RTE_LOG_REGISTER(eth_kni_logtype, pmd.net.kni, NOTICE);
72
73 #define PMD_LOG(level, fmt, args...) \
74         rte_log(RTE_LOG_ ## level, eth_kni_logtype, \
75                 "%s(): " fmt "\n", __func__, ##args)
76 static uint16_t
77 eth_kni_rx(void *q, struct rte_mbuf **bufs, uint16_t nb_bufs)
78 {
79         struct pmd_queue *kni_q = q;
80         struct rte_kni *kni = kni_q->internals->kni;
81         uint16_t nb_pkts;
82         int i;
83
84         nb_pkts = rte_kni_rx_burst(kni, bufs, nb_bufs);
85         for (i = 0; i < nb_pkts; i++)
86                 bufs[i]->port = kni_q->internals->port_id;
87
88         kni_q->rx.pkts += nb_pkts;
89
90         return nb_pkts;
91 }
92
93 static uint16_t
94 eth_kni_tx(void *q, struct rte_mbuf **bufs, uint16_t nb_bufs)
95 {
96         struct pmd_queue *kni_q = q;
97         struct rte_kni *kni = kni_q->internals->kni;
98         uint16_t nb_pkts;
99
100         nb_pkts =  rte_kni_tx_burst(kni, bufs, nb_bufs);
101
102         kni_q->tx.pkts += nb_pkts;
103
104         return nb_pkts;
105 }
106
107 static void *
108 kni_handle_request(void *param)
109 {
110         struct pmd_internals *internals = param;
111 #define MS 1000
112
113         while (!internals->stop_thread) {
114                 rte_kni_handle_request(internals->kni);
115                 usleep(500 * MS);
116         }
117
118         return param;
119 }
120
121 static int
122 eth_kni_start(struct rte_eth_dev *dev)
123 {
124         struct pmd_internals *internals = dev->data->dev_private;
125         uint16_t port_id = dev->data->port_id;
126         struct rte_mempool *mb_pool;
127         struct rte_kni_conf conf;
128         const char *name = dev->device->name + 4; /* remove net_ */
129
130         mb_pool = internals->rx_queues[0].mb_pool;
131         strlcpy(conf.name, name, RTE_KNI_NAMESIZE);
132         conf.force_bind = 0;
133         conf.group_id = port_id;
134         conf.mbuf_size =
135                 rte_pktmbuf_data_room_size(mb_pool) - RTE_PKTMBUF_HEADROOM;
136         conf.mtu = KNI_ETHER_MTU(conf.mbuf_size);
137
138         internals->kni = rte_kni_alloc(mb_pool, &conf, NULL);
139         if (internals->kni == NULL) {
140                 PMD_LOG(ERR,
141                         "Fail to create kni interface for port: %d",
142                         port_id);
143                 return -1;
144         }
145
146         return 0;
147 }
148
149 static int
150 eth_kni_dev_start(struct rte_eth_dev *dev)
151 {
152         struct pmd_internals *internals = dev->data->dev_private;
153         int ret;
154
155         if (internals->is_kni_started == 0) {
156                 ret = eth_kni_start(dev);
157                 if (ret)
158                         return -1;
159                 internals->is_kni_started = 1;
160         }
161
162         if (internals->no_request_thread == 0) {
163                 internals->stop_thread = 0;
164
165                 ret = rte_ctrl_thread_create(&internals->thread,
166                         "kni_handle_req", NULL,
167                         kni_handle_request, internals);
168                 if (ret) {
169                         PMD_LOG(ERR,
170                                 "Fail to create kni request thread");
171                         return -1;
172                 }
173         }
174
175         dev->data->dev_link.link_status = 1;
176
177         return 0;
178 }
179
180 static void
181 eth_kni_dev_stop(struct rte_eth_dev *dev)
182 {
183         struct pmd_internals *internals = dev->data->dev_private;
184         int ret;
185
186         if (internals->no_request_thread == 0 && internals->stop_thread == 0) {
187                 internals->stop_thread = 1;
188
189                 ret = pthread_cancel(internals->thread);
190                 if (ret)
191                         PMD_LOG(ERR, "Can't cancel the thread");
192
193                 ret = pthread_join(internals->thread, NULL);
194                 if (ret)
195                         PMD_LOG(ERR, "Can't join the thread");
196         }
197
198         dev->data->dev_link.link_status = 0;
199 }
200
201 static int
202 eth_kni_close(struct rte_eth_dev *eth_dev)
203 {
204         struct pmd_internals *internals;
205         int ret;
206
207         eth_kni_dev_stop(eth_dev);
208
209         /* mac_addrs must not be freed alone because part of dev_private */
210         eth_dev->data->mac_addrs = NULL;
211
212         internals = eth_dev->data->dev_private;
213         ret = rte_kni_release(internals->kni);
214         if (ret)
215                 PMD_LOG(WARNING, "Not able to release kni for %s",
216                         eth_dev->data->name);
217
218         return 0;
219 }
220
221 static int
222 eth_kni_dev_configure(struct rte_eth_dev *dev __rte_unused)
223 {
224         return 0;
225 }
226
227 static int
228 eth_kni_dev_info(struct rte_eth_dev *dev __rte_unused,
229                 struct rte_eth_dev_info *dev_info)
230 {
231         dev_info->max_mac_addrs = 1;
232         dev_info->max_rx_pktlen = UINT32_MAX;
233         dev_info->max_rx_queues = KNI_MAX_QUEUE_PER_PORT;
234         dev_info->max_tx_queues = KNI_MAX_QUEUE_PER_PORT;
235         dev_info->min_rx_bufsize = 0;
236
237         return 0;
238 }
239
240 static int
241 eth_kni_rx_queue_setup(struct rte_eth_dev *dev,
242                 uint16_t rx_queue_id,
243                 uint16_t nb_rx_desc __rte_unused,
244                 unsigned int socket_id __rte_unused,
245                 const struct rte_eth_rxconf *rx_conf __rte_unused,
246                 struct rte_mempool *mb_pool)
247 {
248         struct pmd_internals *internals = dev->data->dev_private;
249         struct pmd_queue *q;
250
251         q = &internals->rx_queues[rx_queue_id];
252         q->internals = internals;
253         q->mb_pool = mb_pool;
254
255         dev->data->rx_queues[rx_queue_id] = q;
256
257         return 0;
258 }
259
260 static int
261 eth_kni_tx_queue_setup(struct rte_eth_dev *dev,
262                 uint16_t tx_queue_id,
263                 uint16_t nb_tx_desc __rte_unused,
264                 unsigned int socket_id __rte_unused,
265                 const struct rte_eth_txconf *tx_conf __rte_unused)
266 {
267         struct pmd_internals *internals = dev->data->dev_private;
268         struct pmd_queue *q;
269
270         q = &internals->tx_queues[tx_queue_id];
271         q->internals = internals;
272
273         dev->data->tx_queues[tx_queue_id] = q;
274
275         return 0;
276 }
277
278 static void
279 eth_kni_queue_release(void *q __rte_unused)
280 {
281 }
282
283 static int
284 eth_kni_link_update(struct rte_eth_dev *dev __rte_unused,
285                 int wait_to_complete __rte_unused)
286 {
287         return 0;
288 }
289
290 static int
291 eth_kni_stats_get(struct rte_eth_dev *dev, struct rte_eth_stats *stats)
292 {
293         unsigned long rx_packets_total = 0, rx_bytes_total = 0;
294         unsigned long tx_packets_total = 0, tx_bytes_total = 0;
295         struct rte_eth_dev_data *data = dev->data;
296         unsigned int i, num_stats;
297         struct pmd_queue *q;
298
299         num_stats = RTE_MIN((unsigned int)RTE_ETHDEV_QUEUE_STAT_CNTRS,
300                         data->nb_rx_queues);
301         for (i = 0; i < num_stats; i++) {
302                 q = data->rx_queues[i];
303                 stats->q_ipackets[i] = q->rx.pkts;
304                 stats->q_ibytes[i] = q->rx.bytes;
305                 rx_packets_total += stats->q_ipackets[i];
306                 rx_bytes_total += stats->q_ibytes[i];
307         }
308
309         num_stats = RTE_MIN((unsigned int)RTE_ETHDEV_QUEUE_STAT_CNTRS,
310                         data->nb_tx_queues);
311         for (i = 0; i < num_stats; i++) {
312                 q = data->tx_queues[i];
313                 stats->q_opackets[i] = q->tx.pkts;
314                 stats->q_obytes[i] = q->tx.bytes;
315                 tx_packets_total += stats->q_opackets[i];
316                 tx_bytes_total += stats->q_obytes[i];
317         }
318
319         stats->ipackets = rx_packets_total;
320         stats->ibytes = rx_bytes_total;
321         stats->opackets = tx_packets_total;
322         stats->obytes = tx_bytes_total;
323
324         return 0;
325 }
326
327 static int
328 eth_kni_stats_reset(struct rte_eth_dev *dev)
329 {
330         struct rte_eth_dev_data *data = dev->data;
331         struct pmd_queue *q;
332         unsigned int i;
333
334         for (i = 0; i < data->nb_rx_queues; i++) {
335                 q = data->rx_queues[i];
336                 q->rx.pkts = 0;
337                 q->rx.bytes = 0;
338         }
339         for (i = 0; i < data->nb_tx_queues; i++) {
340                 q = data->tx_queues[i];
341                 q->tx.pkts = 0;
342                 q->tx.bytes = 0;
343         }
344
345         return 0;
346 }
347
348 static const struct eth_dev_ops eth_kni_ops = {
349         .dev_start = eth_kni_dev_start,
350         .dev_stop = eth_kni_dev_stop,
351         .dev_close = eth_kni_close,
352         .dev_configure = eth_kni_dev_configure,
353         .dev_infos_get = eth_kni_dev_info,
354         .rx_queue_setup = eth_kni_rx_queue_setup,
355         .tx_queue_setup = eth_kni_tx_queue_setup,
356         .rx_queue_release = eth_kni_queue_release,
357         .tx_queue_release = eth_kni_queue_release,
358         .link_update = eth_kni_link_update,
359         .stats_get = eth_kni_stats_get,
360         .stats_reset = eth_kni_stats_reset,
361 };
362
363 static struct rte_eth_dev *
364 eth_kni_create(struct rte_vdev_device *vdev,
365                 struct eth_kni_args *args,
366                 unsigned int numa_node)
367 {
368         struct pmd_internals *internals;
369         struct rte_eth_dev_data *data;
370         struct rte_eth_dev *eth_dev;
371
372         PMD_LOG(INFO, "Creating kni ethdev on numa socket %u",
373                         numa_node);
374
375         /* reserve an ethdev entry */
376         eth_dev = rte_eth_vdev_allocate(vdev, sizeof(*internals));
377         if (!eth_dev)
378                 return NULL;
379
380         internals = eth_dev->data->dev_private;
381         internals->port_id = eth_dev->data->port_id;
382         data = eth_dev->data;
383         data->nb_rx_queues = 1;
384         data->nb_tx_queues = 1;
385         data->dev_link = pmd_link;
386         data->mac_addrs = &internals->eth_addr;
387         data->promiscuous = 1;
388         data->all_multicast = 1;
389
390         data->dev_flags |= RTE_ETH_DEV_CLOSE_REMOVE;
391
392         rte_eth_random_addr(internals->eth_addr.addr_bytes);
393
394         eth_dev->dev_ops = &eth_kni_ops;
395
396         internals->no_request_thread = args->no_request_thread;
397
398         return eth_dev;
399 }
400
401 static int
402 kni_init(void)
403 {
404         if (is_kni_initialized == 0)
405                 rte_kni_init(MAX_KNI_PORTS);
406
407         is_kni_initialized++;
408
409         return 0;
410 }
411
412 static int
413 eth_kni_kvargs_process(struct eth_kni_args *args, const char *params)
414 {
415         struct rte_kvargs *kvlist;
416
417         kvlist = rte_kvargs_parse(params, valid_arguments);
418         if (kvlist == NULL)
419                 return -1;
420
421         memset(args, 0, sizeof(struct eth_kni_args));
422
423         if (rte_kvargs_count(kvlist, ETH_KNI_NO_REQUEST_THREAD_ARG) == 1)
424                 args->no_request_thread = 1;
425
426         rte_kvargs_free(kvlist);
427
428         return 0;
429 }
430
431 static int
432 eth_kni_probe(struct rte_vdev_device *vdev)
433 {
434         struct rte_eth_dev *eth_dev;
435         struct eth_kni_args args;
436         const char *name;
437         const char *params;
438         int ret;
439
440         name = rte_vdev_device_name(vdev);
441         params = rte_vdev_device_args(vdev);
442         PMD_LOG(INFO, "Initializing eth_kni for %s", name);
443
444         if (rte_eal_process_type() == RTE_PROC_SECONDARY) {
445                 eth_dev = rte_eth_dev_attach_secondary(name);
446                 if (!eth_dev) {
447                         PMD_LOG(ERR, "Failed to probe %s", name);
448                         return -1;
449                 }
450                 /* TODO: request info from primary to set up Rx and Tx */
451                 eth_dev->dev_ops = &eth_kni_ops;
452                 eth_dev->device = &vdev->device;
453                 rte_eth_dev_probing_finish(eth_dev);
454                 return 0;
455         }
456
457         ret = eth_kni_kvargs_process(&args, params);
458         if (ret < 0)
459                 return ret;
460
461         ret = kni_init();
462         if (ret < 0)
463                 return ret;
464
465         eth_dev = eth_kni_create(vdev, &args, rte_socket_id());
466         if (eth_dev == NULL)
467                 goto kni_uninit;
468
469         eth_dev->rx_pkt_burst = eth_kni_rx;
470         eth_dev->tx_pkt_burst = eth_kni_tx;
471
472         rte_eth_dev_probing_finish(eth_dev);
473         return 0;
474
475 kni_uninit:
476         is_kni_initialized--;
477         if (is_kni_initialized == 0)
478                 rte_kni_close();
479         return -1;
480 }
481
482 static int
483 eth_kni_remove(struct rte_vdev_device *vdev)
484 {
485         struct rte_eth_dev *eth_dev;
486         const char *name;
487
488         name = rte_vdev_device_name(vdev);
489         PMD_LOG(INFO, "Un-Initializing eth_kni for %s", name);
490
491         /* find the ethdev entry */
492         eth_dev = rte_eth_dev_allocated(name);
493         if (eth_dev == NULL)
494                 return -1;
495
496         if (rte_eal_process_type() != RTE_PROC_PRIMARY) {
497                 eth_kni_dev_stop(eth_dev);
498                 return rte_eth_dev_release_port(eth_dev);
499         }
500
501         eth_kni_close(eth_dev);
502         rte_eth_dev_release_port(eth_dev);
503
504         is_kni_initialized--;
505         if (is_kni_initialized == 0)
506                 rte_kni_close();
507
508         return 0;
509 }
510
511 static struct rte_vdev_driver eth_kni_drv = {
512         .probe = eth_kni_probe,
513         .remove = eth_kni_remove,
514 };
515
516 RTE_PMD_REGISTER_VDEV(net_kni, eth_kni_drv);
517 RTE_PMD_REGISTER_PARAM_STRING(net_kni, ETH_KNI_NO_REQUEST_THREAD_ARG "=<int>");