a4b9506a9cd7a864de5b91ac8f58bebcd7a495af
[dpdk.git] / lib / librte_eal / linuxapp / eal / eal_interrupts.c
1 /*-
2  *   BSD LICENSE
3  *
4  *   Copyright(c) 2010-2014 Intel Corporation. All rights reserved.
5  *   All rights reserved.
6  *
7  *   Redistribution and use in source and binary forms, with or without
8  *   modification, are permitted provided that the following conditions
9  *   are met:
10  *
11  *     * Redistributions of source code must retain the above copyright
12  *       notice, this list of conditions and the following disclaimer.
13  *     * Redistributions in binary form must reproduce the above copyright
14  *       notice, this list of conditions and the following disclaimer in
15  *       the documentation and/or other materials provided with the
16  *       distribution.
17  *     * Neither the name of Intel Corporation nor the names of its
18  *       contributors may be used to endorse or promote products derived
19  *       from this software without specific prior written permission.
20  *
21  *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
22  *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
23  *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
24  *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
25  *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
26  *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
27  *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28  *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29  *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30  *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
31  *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32  */
33
34 #include <stdio.h>
35 #include <stdint.h>
36 #include <stdlib.h>
37 #include <pthread.h>
38 #include <sys/queue.h>
39 #include <stdarg.h>
40 #include <unistd.h>
41 #include <string.h>
42 #include <errno.h>
43 #include <inttypes.h>
44 #include <sys/epoll.h>
45 #include <sys/signalfd.h>
46 #include <sys/ioctl.h>
47 #include <sys/eventfd.h>
48
49 #include <rte_common.h>
50 #include <rte_interrupts.h>
51 #include <rte_memory.h>
52 #include <rte_memzone.h>
53 #include <rte_launch.h>
54 #include <rte_eal.h>
55 #include <rte_per_lcore.h>
56 #include <rte_lcore.h>
57 #include <rte_atomic.h>
58 #include <rte_branch_prediction.h>
59 #include <rte_ring.h>
60 #include <rte_debug.h>
61 #include <rte_log.h>
62 #include <rte_mempool.h>
63 #include <rte_pci.h>
64 #include <rte_malloc.h>
65 #include <rte_errno.h>
66 #include <rte_spinlock.h>
67
68 #include "eal_private.h"
69 #include "eal_vfio.h"
70 #include "eal_thread.h"
71
72 #define EAL_INTR_EPOLL_WAIT_FOREVER (-1)
73 #define NB_OTHER_INTR               1
74
75 static RTE_DEFINE_PER_LCORE(int, _epfd) = -1; /**< epoll fd per thread */
76
77 /**
78  * union for pipe fds.
79  */
80 union intr_pipefds{
81         struct {
82                 int pipefd[2];
83         };
84         struct {
85                 int readfd;
86                 int writefd;
87         };
88 };
89
90 /**
91  * union buffer for reading on different devices
92  */
93 union rte_intr_read_buffer {
94         int uio_intr_count;              /* for uio device */
95 #ifdef VFIO_PRESENT
96         uint64_t vfio_intr_count;        /* for vfio device */
97 #endif
98         uint64_t timerfd_num;            /* for timerfd */
99         char charbuf[16];                /* for others */
100 };
101
102 TAILQ_HEAD(rte_intr_cb_list, rte_intr_callback);
103 TAILQ_HEAD(rte_intr_source_list, rte_intr_source);
104
105 struct rte_intr_callback {
106         TAILQ_ENTRY(rte_intr_callback) next;
107         rte_intr_callback_fn cb_fn;  /**< callback address */
108         void *cb_arg;                /**< parameter for callback */
109 };
110
111 struct rte_intr_source {
112         TAILQ_ENTRY(rte_intr_source) next;
113         struct rte_intr_handle intr_handle; /**< interrupt handle */
114         struct rte_intr_cb_list callbacks;  /**< user callbacks */
115         uint32_t active;
116 };
117
118 /* global spinlock for interrupt data operation */
119 static rte_spinlock_t intr_lock = RTE_SPINLOCK_INITIALIZER;
120
121 /* union buffer for pipe read/write */
122 static union intr_pipefds intr_pipe;
123
124 /* interrupt sources list */
125 static struct rte_intr_source_list intr_sources;
126
127 /* interrupt handling thread */
128 static pthread_t intr_thread;
129
130 /* VFIO interrupts */
131 #ifdef VFIO_PRESENT
132
133 #define IRQ_SET_BUF_LEN  (sizeof(struct vfio_irq_set) + sizeof(int))
134 /* irq set buffer length for queue interrupts and LSC interrupt */
135 #define MSIX_IRQ_SET_BUF_LEN (sizeof(struct vfio_irq_set) + \
136                               sizeof(int) * (RTE_MAX_RXTX_INTR_VEC_ID + 1))
137
138 /* enable legacy (INTx) interrupts */
139 static int
140 vfio_enable_intx(struct rte_intr_handle *intr_handle) {
141         struct vfio_irq_set *irq_set;
142         char irq_set_buf[IRQ_SET_BUF_LEN];
143         int len, ret;
144         int *fd_ptr;
145
146         len = sizeof(irq_set_buf);
147
148         /* enable INTx */
149         irq_set = (struct vfio_irq_set *) irq_set_buf;
150         irq_set->argsz = len;
151         irq_set->count = 1;
152         irq_set->flags = VFIO_IRQ_SET_DATA_EVENTFD | VFIO_IRQ_SET_ACTION_TRIGGER;
153         irq_set->index = VFIO_PCI_INTX_IRQ_INDEX;
154         irq_set->start = 0;
155         fd_ptr = (int *) &irq_set->data;
156         *fd_ptr = intr_handle->fd;
157
158         ret = ioctl(intr_handle->vfio_dev_fd, VFIO_DEVICE_SET_IRQS, irq_set);
159
160         if (ret) {
161                 RTE_LOG(ERR, EAL, "Error enabling INTx interrupts for fd %d\n",
162                                                 intr_handle->fd);
163                 return -1;
164         }
165
166         /* unmask INTx after enabling */
167         memset(irq_set, 0, len);
168         len = sizeof(struct vfio_irq_set);
169         irq_set->argsz = len;
170         irq_set->count = 1;
171         irq_set->flags = VFIO_IRQ_SET_DATA_NONE | VFIO_IRQ_SET_ACTION_UNMASK;
172         irq_set->index = VFIO_PCI_INTX_IRQ_INDEX;
173         irq_set->start = 0;
174
175         ret = ioctl(intr_handle->vfio_dev_fd, VFIO_DEVICE_SET_IRQS, irq_set);
176
177         if (ret) {
178                 RTE_LOG(ERR, EAL, "Error unmasking INTx interrupts for fd %d\n",
179                                                 intr_handle->fd);
180                 return -1;
181         }
182         return 0;
183 }
184
185 /* disable legacy (INTx) interrupts */
186 static int
187 vfio_disable_intx(struct rte_intr_handle *intr_handle) {
188         struct vfio_irq_set *irq_set;
189         char irq_set_buf[IRQ_SET_BUF_LEN];
190         int len, ret;
191
192         len = sizeof(struct vfio_irq_set);
193
194         /* mask interrupts before disabling */
195         irq_set = (struct vfio_irq_set *) irq_set_buf;
196         irq_set->argsz = len;
197         irq_set->count = 1;
198         irq_set->flags = VFIO_IRQ_SET_DATA_NONE | VFIO_IRQ_SET_ACTION_UNMASK;
199         irq_set->index = VFIO_PCI_INTX_IRQ_INDEX;
200         irq_set->start = 0;
201
202         ret = ioctl(intr_handle->vfio_dev_fd, VFIO_DEVICE_SET_IRQS, irq_set);
203
204         if (ret) {
205                 RTE_LOG(ERR, EAL, "Error unmasking INTx interrupts for fd %d\n",
206                                                 intr_handle->fd);
207                 return -1;
208         }
209
210         /* disable INTx*/
211         memset(irq_set, 0, len);
212         irq_set->argsz = len;
213         irq_set->count = 0;
214         irq_set->flags = VFIO_IRQ_SET_DATA_NONE | VFIO_IRQ_SET_ACTION_TRIGGER;
215         irq_set->index = VFIO_PCI_INTX_IRQ_INDEX;
216         irq_set->start = 0;
217
218         ret = ioctl(intr_handle->vfio_dev_fd, VFIO_DEVICE_SET_IRQS, irq_set);
219
220         if (ret) {
221                 RTE_LOG(ERR, EAL,
222                         "Error disabling INTx interrupts for fd %d\n", intr_handle->fd);
223                 return -1;
224         }
225         return 0;
226 }
227
228 /* enable MSI interrupts */
229 static int
230 vfio_enable_msi(struct rte_intr_handle *intr_handle) {
231         int len, ret;
232         char irq_set_buf[IRQ_SET_BUF_LEN];
233         struct vfio_irq_set *irq_set;
234         int *fd_ptr;
235
236         len = sizeof(irq_set_buf);
237
238         irq_set = (struct vfio_irq_set *) irq_set_buf;
239         irq_set->argsz = len;
240         irq_set->count = 1;
241         irq_set->flags = VFIO_IRQ_SET_DATA_EVENTFD | VFIO_IRQ_SET_ACTION_TRIGGER;
242         irq_set->index = VFIO_PCI_MSI_IRQ_INDEX;
243         irq_set->start = 0;
244         fd_ptr = (int *) &irq_set->data;
245         *fd_ptr = intr_handle->fd;
246
247         ret = ioctl(intr_handle->vfio_dev_fd, VFIO_DEVICE_SET_IRQS, irq_set);
248
249         if (ret) {
250                 RTE_LOG(ERR, EAL, "Error enabling MSI interrupts for fd %d\n",
251                                                 intr_handle->fd);
252                 return -1;
253         }
254         return 0;
255 }
256
257 /* disable MSI interrupts */
258 static int
259 vfio_disable_msi(struct rte_intr_handle *intr_handle) {
260         struct vfio_irq_set *irq_set;
261         char irq_set_buf[IRQ_SET_BUF_LEN];
262         int len, ret;
263
264         len = sizeof(struct vfio_irq_set);
265
266         irq_set = (struct vfio_irq_set *) irq_set_buf;
267         irq_set->argsz = len;
268         irq_set->count = 0;
269         irq_set->flags = VFIO_IRQ_SET_DATA_NONE | VFIO_IRQ_SET_ACTION_TRIGGER;
270         irq_set->index = VFIO_PCI_MSI_IRQ_INDEX;
271         irq_set->start = 0;
272
273         ret = ioctl(intr_handle->vfio_dev_fd, VFIO_DEVICE_SET_IRQS, irq_set);
274
275         if (ret)
276                 RTE_LOG(ERR, EAL,
277                         "Error disabling MSI interrupts for fd %d\n", intr_handle->fd);
278
279         return ret;
280 }
281
282 /* enable MSI-X interrupts */
283 static int
284 vfio_enable_msix(struct rte_intr_handle *intr_handle) {
285         int len, ret;
286         char irq_set_buf[MSIX_IRQ_SET_BUF_LEN];
287         struct vfio_irq_set *irq_set;
288         int *fd_ptr;
289
290         len = sizeof(irq_set_buf);
291
292         irq_set = (struct vfio_irq_set *) irq_set_buf;
293         irq_set->argsz = len;
294         if (!intr_handle->max_intr)
295                 intr_handle->max_intr = 1;
296         else if (intr_handle->max_intr > RTE_MAX_RXTX_INTR_VEC_ID)
297                 intr_handle->max_intr = RTE_MAX_RXTX_INTR_VEC_ID + 1;
298
299         irq_set->count = intr_handle->max_intr;
300         irq_set->flags = VFIO_IRQ_SET_DATA_EVENTFD | VFIO_IRQ_SET_ACTION_TRIGGER;
301         irq_set->index = VFIO_PCI_MSIX_IRQ_INDEX;
302         irq_set->start = 0;
303         fd_ptr = (int *) &irq_set->data;
304         memcpy(fd_ptr, intr_handle->efds, sizeof(intr_handle->efds));
305         fd_ptr[intr_handle->max_intr - 1] = intr_handle->fd;
306
307         ret = ioctl(intr_handle->vfio_dev_fd, VFIO_DEVICE_SET_IRQS, irq_set);
308
309         if (ret) {
310                 RTE_LOG(ERR, EAL, "Error enabling MSI-X interrupts for fd %d\n",
311                                                 intr_handle->fd);
312                 return -1;
313         }
314
315         return 0;
316 }
317
318 /* disable MSI-X interrupts */
319 static int
320 vfio_disable_msix(struct rte_intr_handle *intr_handle) {
321         struct vfio_irq_set *irq_set;
322         char irq_set_buf[MSIX_IRQ_SET_BUF_LEN];
323         int len, ret;
324
325         len = sizeof(struct vfio_irq_set);
326
327         irq_set = (struct vfio_irq_set *) irq_set_buf;
328         irq_set->argsz = len;
329         irq_set->count = 0;
330         irq_set->flags = VFIO_IRQ_SET_DATA_NONE | VFIO_IRQ_SET_ACTION_TRIGGER;
331         irq_set->index = VFIO_PCI_MSIX_IRQ_INDEX;
332         irq_set->start = 0;
333
334         ret = ioctl(intr_handle->vfio_dev_fd, VFIO_DEVICE_SET_IRQS, irq_set);
335
336         if (ret)
337                 RTE_LOG(ERR, EAL,
338                         "Error disabling MSI-X interrupts for fd %d\n", intr_handle->fd);
339
340         return ret;
341 }
342 #endif
343
344 static int
345 uio_intx_intr_disable(struct rte_intr_handle *intr_handle)
346 {
347         unsigned char command_high;
348
349         /* use UIO config file descriptor for uio_pci_generic */
350         if (pread(intr_handle->uio_cfg_fd, &command_high, 1, 5) != 1) {
351                 RTE_LOG(ERR, EAL,
352                         "Error reading interrupts status for fd %d\n",
353                         intr_handle->uio_cfg_fd);
354                 return -1;
355         }
356         /* disable interrupts */
357         command_high |= 0x4;
358         if (pwrite(intr_handle->uio_cfg_fd, &command_high, 1, 5) != 1) {
359                 RTE_LOG(ERR, EAL,
360                         "Error disabling interrupts for fd %d\n",
361                         intr_handle->uio_cfg_fd);
362                 return -1;
363         }
364
365         return 0;
366 }
367
368 static int
369 uio_intx_intr_enable(struct rte_intr_handle *intr_handle)
370 {
371         unsigned char command_high;
372
373         /* use UIO config file descriptor for uio_pci_generic */
374         if (pread(intr_handle->uio_cfg_fd, &command_high, 1, 5) != 1) {
375                 RTE_LOG(ERR, EAL,
376                         "Error reading interrupts status for fd %d\n",
377                         intr_handle->uio_cfg_fd);
378                 return -1;
379         }
380         /* enable interrupts */
381         command_high &= ~0x4;
382         if (pwrite(intr_handle->uio_cfg_fd, &command_high, 1, 5) != 1) {
383                 RTE_LOG(ERR, EAL,
384                         "Error enabling interrupts for fd %d\n",
385                         intr_handle->uio_cfg_fd);
386                 return -1;
387         }
388
389         return 0;
390 }
391
392 static int
393 uio_intr_disable(struct rte_intr_handle *intr_handle)
394 {
395         const int value = 0;
396
397         if (write(intr_handle->fd, &value, sizeof(value)) < 0) {
398                 RTE_LOG(ERR, EAL,
399                         "Error disabling interrupts for fd %d (%s)\n",
400                         intr_handle->fd, strerror(errno));
401                 return -1;
402         }
403         return 0;
404 }
405
406 static int
407 uio_intr_enable(struct rte_intr_handle *intr_handle)
408 {
409         const int value = 1;
410
411         if (write(intr_handle->fd, &value, sizeof(value)) < 0) {
412                 RTE_LOG(ERR, EAL,
413                         "Error enabling interrupts for fd %d (%s)\n",
414                         intr_handle->fd, strerror(errno));
415                 return -1;
416         }
417         return 0;
418 }
419
420 int
421 rte_intr_callback_register(struct rte_intr_handle *intr_handle,
422                         rte_intr_callback_fn cb, void *cb_arg)
423 {
424         int ret, wake_thread;
425         struct rte_intr_source *src;
426         struct rte_intr_callback *callback;
427
428         wake_thread = 0;
429
430         /* first do parameter checking */
431         if (intr_handle == NULL || intr_handle->fd < 0 || cb == NULL) {
432                 RTE_LOG(ERR, EAL,
433                         "Registering with invalid input parameter\n");
434                 return -EINVAL;
435         }
436
437         /* allocate a new interrupt callback entity */
438         callback = rte_zmalloc("interrupt callback list",
439                                 sizeof(*callback), 0);
440         if (callback == NULL) {
441                 RTE_LOG(ERR, EAL, "Can not allocate memory\n");
442                 return -ENOMEM;
443         }
444         callback->cb_fn = cb;
445         callback->cb_arg = cb_arg;
446
447         rte_spinlock_lock(&intr_lock);
448
449         /* check if there is at least one callback registered for the fd */
450         TAILQ_FOREACH(src, &intr_sources, next) {
451                 if (src->intr_handle.fd == intr_handle->fd) {
452                         /* we had no interrupts for this */
453                         if TAILQ_EMPTY(&src->callbacks)
454                                 wake_thread = 1;
455
456                         TAILQ_INSERT_TAIL(&(src->callbacks), callback, next);
457                         ret = 0;
458                         break;
459                 }
460         }
461
462         /* no existing callbacks for this - add new source */
463         if (src == NULL) {
464                 if ((src = rte_zmalloc("interrupt source list",
465                                 sizeof(*src), 0)) == NULL) {
466                         RTE_LOG(ERR, EAL, "Can not allocate memory\n");
467                         rte_free(callback);
468                         ret = -ENOMEM;
469                 } else {
470                         src->intr_handle = *intr_handle;
471                         TAILQ_INIT(&src->callbacks);
472                         TAILQ_INSERT_TAIL(&(src->callbacks), callback, next);
473                         TAILQ_INSERT_TAIL(&intr_sources, src, next);
474                         wake_thread = 1;
475                         ret = 0;
476                 }
477         }
478
479         rte_spinlock_unlock(&intr_lock);
480
481         /**
482          * check if need to notify the pipe fd waited by epoll_wait to
483          * rebuild the wait list.
484          */
485         if (wake_thread)
486                 if (write(intr_pipe.writefd, "1", 1) < 0)
487                         return -EPIPE;
488
489         return ret;
490 }
491
492 int
493 rte_intr_callback_unregister(struct rte_intr_handle *intr_handle,
494                         rte_intr_callback_fn cb_fn, void *cb_arg)
495 {
496         int ret;
497         struct rte_intr_source *src;
498         struct rte_intr_callback *cb, *next;
499
500         /* do parameter checking first */
501         if (intr_handle == NULL || intr_handle->fd < 0) {
502                 RTE_LOG(ERR, EAL,
503                 "Unregistering with invalid input parameter\n");
504                 return -EINVAL;
505         }
506
507         rte_spinlock_lock(&intr_lock);
508
509         /* check if the insterrupt source for the fd is existent */
510         TAILQ_FOREACH(src, &intr_sources, next)
511                 if (src->intr_handle.fd == intr_handle->fd)
512                         break;
513
514         /* No interrupt source registered for the fd */
515         if (src == NULL) {
516                 ret = -ENOENT;
517
518         /* interrupt source has some active callbacks right now. */
519         } else if (src->active != 0) {
520                 ret = -EAGAIN;
521
522         /* ok to remove. */
523         } else {
524                 ret = 0;
525
526                 /*walk through the callbacks and remove all that match. */
527                 for (cb = TAILQ_FIRST(&src->callbacks); cb != NULL; cb = next) {
528
529                         next = TAILQ_NEXT(cb, next);
530
531                         if (cb->cb_fn == cb_fn && (cb_arg == (void *)-1 ||
532                                         cb->cb_arg == cb_arg)) {
533                                 TAILQ_REMOVE(&src->callbacks, cb, next);
534                                 rte_free(cb);
535                                 ret++;
536                         }
537                 }
538
539                 /* all callbacks for that source are removed. */
540                 if (TAILQ_EMPTY(&src->callbacks)) {
541                         TAILQ_REMOVE(&intr_sources, src, next);
542                         rte_free(src);
543                 }
544         }
545
546         rte_spinlock_unlock(&intr_lock);
547
548         /* notify the pipe fd waited by epoll_wait to rebuild the wait list */
549         if (ret >= 0 && write(intr_pipe.writefd, "1", 1) < 0) {
550                 ret = -EPIPE;
551         }
552
553         return ret;
554 }
555
556 int
557 rte_intr_enable(struct rte_intr_handle *intr_handle)
558 {
559         if (!intr_handle || intr_handle->fd < 0 || intr_handle->uio_cfg_fd < 0)
560                 return -1;
561
562         switch (intr_handle->type){
563         /* write to the uio fd to enable the interrupt */
564         case RTE_INTR_HANDLE_UIO:
565                 if (uio_intr_enable(intr_handle))
566                         return -1;
567                 break;
568         case RTE_INTR_HANDLE_UIO_INTX:
569                 if (uio_intx_intr_enable(intr_handle))
570                         return -1;
571                 break;
572         /* not used at this moment */
573         case RTE_INTR_HANDLE_ALARM:
574                 return -1;
575 #ifdef VFIO_PRESENT
576         case RTE_INTR_HANDLE_VFIO_MSIX:
577                 if (vfio_enable_msix(intr_handle))
578                         return -1;
579                 break;
580         case RTE_INTR_HANDLE_VFIO_MSI:
581                 if (vfio_enable_msi(intr_handle))
582                         return -1;
583                 break;
584         case RTE_INTR_HANDLE_VFIO_LEGACY:
585                 if (vfio_enable_intx(intr_handle))
586                         return -1;
587                 break;
588 #endif
589         /* unknown handle type */
590         default:
591                 RTE_LOG(ERR, EAL,
592                         "Unknown handle type of fd %d\n",
593                                         intr_handle->fd);
594                 return -1;
595         }
596
597         return 0;
598 }
599
600 int
601 rte_intr_disable(struct rte_intr_handle *intr_handle)
602 {
603         if (!intr_handle || intr_handle->fd < 0 || intr_handle->uio_cfg_fd < 0)
604                 return -1;
605
606         switch (intr_handle->type){
607         /* write to the uio fd to disable the interrupt */
608         case RTE_INTR_HANDLE_UIO:
609                 if (uio_intr_disable(intr_handle))
610                         return -1;
611                 break;
612         case RTE_INTR_HANDLE_UIO_INTX:
613                 if (uio_intx_intr_disable(intr_handle))
614                         return -1;
615                 break;
616         /* not used at this moment */
617         case RTE_INTR_HANDLE_ALARM:
618                 return -1;
619 #ifdef VFIO_PRESENT
620         case RTE_INTR_HANDLE_VFIO_MSIX:
621                 if (vfio_disable_msix(intr_handle))
622                         return -1;
623                 break;
624         case RTE_INTR_HANDLE_VFIO_MSI:
625                 if (vfio_disable_msi(intr_handle))
626                         return -1;
627                 break;
628         case RTE_INTR_HANDLE_VFIO_LEGACY:
629                 if (vfio_disable_intx(intr_handle))
630                         return -1;
631                 break;
632 #endif
633         /* unknown handle type */
634         default:
635                 RTE_LOG(ERR, EAL,
636                         "Unknown handle type of fd %d\n",
637                                         intr_handle->fd);
638                 return -1;
639         }
640
641         return 0;
642 }
643
644 static int
645 eal_intr_process_interrupts(struct epoll_event *events, int nfds)
646 {
647         int n, bytes_read;
648         struct rte_intr_source *src;
649         struct rte_intr_callback *cb;
650         union rte_intr_read_buffer buf;
651         struct rte_intr_callback active_cb;
652
653         for (n = 0; n < nfds; n++) {
654
655                 /**
656                  * if the pipe fd is ready to read, return out to
657                  * rebuild the wait list.
658                  */
659                 if (events[n].data.fd == intr_pipe.readfd){
660                         int r = read(intr_pipe.readfd, buf.charbuf,
661                                         sizeof(buf.charbuf));
662                         RTE_SET_USED(r);
663                         return -1;
664                 }
665                 rte_spinlock_lock(&intr_lock);
666                 TAILQ_FOREACH(src, &intr_sources, next)
667                         if (src->intr_handle.fd ==
668                                         events[n].data.fd)
669                                 break;
670                 if (src == NULL){
671                         rte_spinlock_unlock(&intr_lock);
672                         continue;
673                 }
674
675                 /* mark this interrupt source as active and release the lock. */
676                 src->active = 1;
677                 rte_spinlock_unlock(&intr_lock);
678
679                 /* set the length to be read dor different handle type */
680                 switch (src->intr_handle.type) {
681                 case RTE_INTR_HANDLE_UIO:
682                 case RTE_INTR_HANDLE_UIO_INTX:
683                         bytes_read = sizeof(buf.uio_intr_count);
684                         break;
685                 case RTE_INTR_HANDLE_ALARM:
686                         bytes_read = sizeof(buf.timerfd_num);
687                         break;
688 #ifdef VFIO_PRESENT
689                 case RTE_INTR_HANDLE_VFIO_MSIX:
690                 case RTE_INTR_HANDLE_VFIO_MSI:
691                 case RTE_INTR_HANDLE_VFIO_LEGACY:
692                         bytes_read = sizeof(buf.vfio_intr_count);
693                         break;
694 #endif
695                 case RTE_INTR_HANDLE_EXT:
696                 default:
697                         bytes_read = 1;
698                         break;
699                 }
700
701                 if (src->intr_handle.type != RTE_INTR_HANDLE_EXT) {
702                         /**
703                          * read out to clear the ready-to-be-read flag
704                          * for epoll_wait.
705                          */
706                         bytes_read = read(events[n].data.fd, &buf, bytes_read);
707                         if (bytes_read < 0) {
708                                 if (errno == EINTR || errno == EWOULDBLOCK)
709                                         continue;
710
711                                 RTE_LOG(ERR, EAL, "Error reading from file "
712                                         "descriptor %d: %s\n",
713                                         events[n].data.fd,
714                                         strerror(errno));
715                         } else if (bytes_read == 0)
716                                 RTE_LOG(ERR, EAL, "Read nothing from file "
717                                         "descriptor %d\n", events[n].data.fd);
718                 }
719
720                 /* grab a lock, again to call callbacks and update status. */
721                 rte_spinlock_lock(&intr_lock);
722
723                 if (bytes_read > 0) {
724
725                         /* Finally, call all callbacks. */
726                         TAILQ_FOREACH(cb, &src->callbacks, next) {
727
728                                 /* make a copy and unlock. */
729                                 active_cb = *cb;
730                                 rte_spinlock_unlock(&intr_lock);
731
732                                 /* call the actual callback */
733                                 active_cb.cb_fn(&src->intr_handle,
734                                         active_cb.cb_arg);
735
736                                 /*get the lock back. */
737                                 rte_spinlock_lock(&intr_lock);
738                         }
739                 }
740
741                 /* we done with that interrupt source, release it. */
742                 src->active = 0;
743                 rte_spinlock_unlock(&intr_lock);
744         }
745
746         return 0;
747 }
748
749 /**
750  * It handles all the interrupts.
751  *
752  * @param pfd
753  *  epoll file descriptor.
754  * @param totalfds
755  *  The number of file descriptors added in epoll.
756  *
757  * @return
758  *  void
759  */
760 static void
761 eal_intr_handle_interrupts(int pfd, unsigned totalfds)
762 {
763         struct epoll_event events[totalfds];
764         int nfds = 0;
765
766         for(;;) {
767                 nfds = epoll_wait(pfd, events, totalfds,
768                         EAL_INTR_EPOLL_WAIT_FOREVER);
769                 /* epoll_wait fail */
770                 if (nfds < 0) {
771                         if (errno == EINTR)
772                                 continue;
773                         RTE_LOG(ERR, EAL,
774                                 "epoll_wait returns with fail\n");
775                         return;
776                 }
777                 /* epoll_wait timeout, will never happens here */
778                 else if (nfds == 0)
779                         continue;
780                 /* epoll_wait has at least one fd ready to read */
781                 if (eal_intr_process_interrupts(events, nfds) < 0)
782                         return;
783         }
784 }
785
786 /**
787  * It builds/rebuilds up the epoll file descriptor with all the
788  * file descriptors being waited on. Then handles the interrupts.
789  *
790  * @param arg
791  *  pointer. (unused)
792  *
793  * @return
794  *  never return;
795  */
796 static __attribute__((noreturn)) void *
797 eal_intr_thread_main(__rte_unused void *arg)
798 {
799         struct epoll_event ev;
800
801         /* host thread, never break out */
802         for (;;) {
803                 /* build up the epoll fd with all descriptors we are to
804                  * wait on then pass it to the handle_interrupts function
805                  */
806                 static struct epoll_event pipe_event = {
807                         .events = EPOLLIN | EPOLLPRI,
808                 };
809                 struct rte_intr_source *src;
810                 unsigned numfds = 0;
811
812                 /* create epoll fd */
813                 int pfd = epoll_create(1);
814                 if (pfd < 0)
815                         rte_panic("Cannot create epoll instance\n");
816
817                 pipe_event.data.fd = intr_pipe.readfd;
818                 /**
819                  * add pipe fd into wait list, this pipe is used to
820                  * rebuild the wait list.
821                  */
822                 if (epoll_ctl(pfd, EPOLL_CTL_ADD, intr_pipe.readfd,
823                                                 &pipe_event) < 0) {
824                         rte_panic("Error adding fd to %d epoll_ctl, %s\n",
825                                         intr_pipe.readfd, strerror(errno));
826                 }
827                 numfds++;
828
829                 rte_spinlock_lock(&intr_lock);
830
831                 TAILQ_FOREACH(src, &intr_sources, next) {
832                         if (src->callbacks.tqh_first == NULL)
833                                 continue; /* skip those with no callbacks */
834                         ev.events = EPOLLIN | EPOLLPRI;
835                         ev.data.fd = src->intr_handle.fd;
836
837                         /**
838                          * add all the uio device file descriptor
839                          * into wait list.
840                          */
841                         if (epoll_ctl(pfd, EPOLL_CTL_ADD,
842                                         src->intr_handle.fd, &ev) < 0){
843                                 rte_panic("Error adding fd %d epoll_ctl, %s\n",
844                                         src->intr_handle.fd, strerror(errno));
845                         }
846                         else
847                                 numfds++;
848                 }
849                 rte_spinlock_unlock(&intr_lock);
850                 /* serve the interrupt */
851                 eal_intr_handle_interrupts(pfd, numfds);
852
853                 /**
854                  * when we return, we need to rebuild the
855                  * list of fds to monitor.
856                  */
857                 close(pfd);
858         }
859 }
860
861 int
862 rte_eal_intr_init(void)
863 {
864         int ret = 0, ret_1 = 0;
865         char thread_name[RTE_MAX_THREAD_NAME_LEN];
866
867         /* init the global interrupt source head */
868         TAILQ_INIT(&intr_sources);
869
870         /**
871          * create a pipe which will be waited by epoll and notified to
872          * rebuild the wait list of epoll.
873          */
874         if (pipe(intr_pipe.pipefd) < 0)
875                 return -1;
876
877         /* create the host thread to wait/handle the interrupt */
878         ret = pthread_create(&intr_thread, NULL,
879                         eal_intr_thread_main, NULL);
880         if (ret != 0) {
881                 RTE_LOG(ERR, EAL,
882                         "Failed to create thread for interrupt handling\n");
883         } else {
884                 /* Set thread_name for aid in debugging. */
885                 snprintf(thread_name, RTE_MAX_THREAD_NAME_LEN,
886                         "eal-intr-thread");
887                 ret_1 = pthread_setname_np(intr_thread, thread_name);
888                 if (ret_1 != 0)
889                         RTE_LOG(ERR, EAL,
890                         "Failed to set thread name for interrupt handling\n");
891         }
892
893         return -ret;
894 }
895
896 static void
897 eal_intr_proc_rxtx_intr(int fd, const struct rte_intr_handle *intr_handle)
898 {
899         union rte_intr_read_buffer buf;
900         int bytes_read = 1;
901
902         switch (intr_handle->type) {
903         case RTE_INTR_HANDLE_UIO:
904         case RTE_INTR_HANDLE_UIO_INTX:
905                 bytes_read = sizeof(buf.uio_intr_count);
906                 break;
907 #ifdef VFIO_PRESENT
908         case RTE_INTR_HANDLE_VFIO_MSIX:
909         case RTE_INTR_HANDLE_VFIO_MSI:
910         case RTE_INTR_HANDLE_VFIO_LEGACY:
911                 bytes_read = sizeof(buf.vfio_intr_count);
912                 break;
913 #endif
914         default:
915                 bytes_read = 1;
916                 RTE_LOG(INFO, EAL, "unexpected intr type\n");
917                 break;
918         }
919
920         /**
921          * read out to clear the ready-to-be-read flag
922          * for epoll_wait.
923          */
924         do {
925                 bytes_read = read(fd, &buf, bytes_read);
926                 if (bytes_read < 0) {
927                         if (errno == EINTR || errno == EWOULDBLOCK ||
928                             errno == EAGAIN)
929                                 continue;
930                         RTE_LOG(ERR, EAL,
931                                 "Error reading from fd %d: %s\n",
932                                 fd, strerror(errno));
933                 } else if (bytes_read == 0)
934                         RTE_LOG(ERR, EAL, "Read nothing from fd %d\n", fd);
935                 return;
936         } while (1);
937 }
938
939 static int
940 eal_epoll_process_event(struct epoll_event *evs, unsigned int n,
941                         struct rte_epoll_event *events)
942 {
943         unsigned int i, count = 0;
944         struct rte_epoll_event *rev;
945
946         for (i = 0; i < n; i++) {
947                 rev = evs[i].data.ptr;
948                 if (!rev || !rte_atomic32_cmpset(&rev->status, RTE_EPOLL_VALID,
949                                                  RTE_EPOLL_EXEC))
950                         continue;
951
952                 events[count].status        = RTE_EPOLL_VALID;
953                 events[count].fd            = rev->fd;
954                 events[count].epfd          = rev->epfd;
955                 events[count].epdata.event  = rev->epdata.event;
956                 events[count].epdata.data   = rev->epdata.data;
957                 if (rev->epdata.cb_fun)
958                         rev->epdata.cb_fun(rev->fd,
959                                            rev->epdata.cb_arg);
960
961                 rte_compiler_barrier();
962                 rev->status = RTE_EPOLL_VALID;
963                 count++;
964         }
965         return count;
966 }
967
968 static inline int
969 eal_init_tls_epfd(void)
970 {
971         int pfd = epoll_create(255);
972
973         if (pfd < 0) {
974                 RTE_LOG(ERR, EAL,
975                         "Cannot create epoll instance\n");
976                 return -1;
977         }
978         return pfd;
979 }
980
981 int
982 rte_intr_tls_epfd(void)
983 {
984         if (RTE_PER_LCORE(_epfd) == -1)
985                 RTE_PER_LCORE(_epfd) = eal_init_tls_epfd();
986
987         return RTE_PER_LCORE(_epfd);
988 }
989
990 int
991 rte_epoll_wait(int epfd, struct rte_epoll_event *events,
992                int maxevents, int timeout)
993 {
994         struct epoll_event evs[maxevents];
995         int rc;
996
997         if (!events) {
998                 RTE_LOG(ERR, EAL, "rte_epoll_event can't be NULL\n");
999                 return -1;
1000         }
1001
1002         /* using per thread epoll fd */
1003         if (epfd == RTE_EPOLL_PER_THREAD)
1004                 epfd = rte_intr_tls_epfd();
1005
1006         while (1) {
1007                 rc = epoll_wait(epfd, evs, maxevents, timeout);
1008                 if (likely(rc > 0)) {
1009                         /* epoll_wait has at least one fd ready to read */
1010                         rc = eal_epoll_process_event(evs, rc, events);
1011                         break;
1012                 } else if (rc < 0) {
1013                         if (errno == EINTR)
1014                                 continue;
1015                         /* epoll_wait fail */
1016                         RTE_LOG(ERR, EAL, "epoll_wait returns with fail %s\n",
1017                                 strerror(errno));
1018                         rc = -1;
1019                         break;
1020                 } else {
1021                         /* rc == 0, epoll_wait timed out */
1022                         break;
1023                 }
1024         }
1025
1026         return rc;
1027 }
1028
1029 static inline void
1030 eal_epoll_data_safe_free(struct rte_epoll_event *ev)
1031 {
1032         while (!rte_atomic32_cmpset(&ev->status, RTE_EPOLL_VALID,
1033                                     RTE_EPOLL_INVALID))
1034                 while (ev->status != RTE_EPOLL_VALID)
1035                         rte_pause();
1036         memset(&ev->epdata, 0, sizeof(ev->epdata));
1037         ev->fd = -1;
1038         ev->epfd = -1;
1039 }
1040
1041 int
1042 rte_epoll_ctl(int epfd, int op, int fd,
1043               struct rte_epoll_event *event)
1044 {
1045         struct epoll_event ev;
1046
1047         if (!event) {
1048                 RTE_LOG(ERR, EAL, "rte_epoll_event can't be NULL\n");
1049                 return -1;
1050         }
1051
1052         /* using per thread epoll fd */
1053         if (epfd == RTE_EPOLL_PER_THREAD)
1054                 epfd = rte_intr_tls_epfd();
1055
1056         if (op == EPOLL_CTL_ADD) {
1057                 event->status = RTE_EPOLL_VALID;
1058                 event->fd = fd;  /* ignore fd in event */
1059                 event->epfd = epfd;
1060                 ev.data.ptr = (void *)event;
1061         }
1062
1063         ev.events = event->epdata.event;
1064         if (epoll_ctl(epfd, op, fd, &ev) < 0) {
1065                 RTE_LOG(ERR, EAL, "Error op %d fd %d epoll_ctl, %s\n",
1066                         op, fd, strerror(errno));
1067                 if (op == EPOLL_CTL_ADD)
1068                         /* rollback status when CTL_ADD fail */
1069                         event->status = RTE_EPOLL_INVALID;
1070                 return -1;
1071         }
1072
1073         if (op == EPOLL_CTL_DEL && event->status != RTE_EPOLL_INVALID)
1074                 eal_epoll_data_safe_free(event);
1075
1076         return 0;
1077 }
1078
1079 int
1080 rte_intr_rx_ctl(struct rte_intr_handle *intr_handle, int epfd,
1081                 int op, unsigned int vec, void *data)
1082 {
1083         struct rte_epoll_event *rev;
1084         struct rte_epoll_data *epdata;
1085         int epfd_op;
1086         int rc = 0;
1087
1088         if (!intr_handle || intr_handle->nb_efd == 0 ||
1089             vec >= intr_handle->nb_efd) {
1090                 RTE_LOG(ERR, EAL, "Wrong intr vector number.\n");
1091                 return -EPERM;
1092         }
1093
1094         switch (op) {
1095         case RTE_INTR_EVENT_ADD:
1096                 epfd_op = EPOLL_CTL_ADD;
1097                 rev = &intr_handle->elist[vec];
1098                 if (rev->status != RTE_EPOLL_INVALID) {
1099                         RTE_LOG(INFO, EAL, "Event already been added.\n");
1100                         return -EEXIST;
1101                 }
1102
1103                 /* attach to intr vector fd */
1104                 epdata = &rev->epdata;
1105                 epdata->event  = EPOLLIN | EPOLLPRI | EPOLLET;
1106                 epdata->data   = data;
1107                 epdata->cb_fun = (rte_intr_event_cb_t)eal_intr_proc_rxtx_intr;
1108                 epdata->cb_arg = (void *)intr_handle;
1109                 rc = rte_epoll_ctl(epfd, epfd_op, intr_handle->efds[vec], rev);
1110                 if (!rc)
1111                         RTE_LOG(DEBUG, EAL,
1112                                 "efd %d associated with vec %d added on epfd %d"
1113                                 "\n", rev->fd, vec, epfd);
1114                 else
1115                         rc = -EPERM;
1116                 break;
1117         case RTE_INTR_EVENT_DEL:
1118                 epfd_op = EPOLL_CTL_DEL;
1119                 rev = &intr_handle->elist[vec];
1120                 if (rev->status == RTE_EPOLL_INVALID) {
1121                         RTE_LOG(INFO, EAL, "Event does not exist.\n");
1122                         return -EPERM;
1123                 }
1124
1125                 rc = rte_epoll_ctl(rev->epfd, epfd_op, rev->fd, rev);
1126                 if (rc)
1127                         rc = -EPERM;
1128                 break;
1129         default:
1130                 RTE_LOG(ERR, EAL, "event op type mismatch\n");
1131                 rc = -EPERM;
1132         }
1133
1134         return rc;
1135 }
1136
1137 int
1138 rte_intr_efd_enable(struct rte_intr_handle *intr_handle, uint32_t nb_efd)
1139 {
1140         uint32_t i;
1141         int fd;
1142         uint32_t n = RTE_MIN(nb_efd, (uint32_t)RTE_MAX_RXTX_INTR_VEC_ID);
1143
1144         if (intr_handle->type == RTE_INTR_HANDLE_VFIO_MSIX) {
1145                 for (i = 0; i < n; i++) {
1146                         fd = eventfd(0, EFD_NONBLOCK | EFD_CLOEXEC);
1147                         if (fd < 0) {
1148                                 RTE_LOG(ERR, EAL,
1149                                         "can't setup eventfd, error %i (%s)\n",
1150                                         errno, strerror(errno));
1151                                 return -1;
1152                         }
1153                         intr_handle->efds[i] = fd;
1154                 }
1155                 intr_handle->nb_efd   = n;
1156                 intr_handle->max_intr = NB_OTHER_INTR + n;
1157         } else {
1158                 intr_handle->efds[0]  = intr_handle->fd;
1159                 intr_handle->nb_efd   = RTE_MIN(nb_efd, 1U);
1160                 intr_handle->max_intr = NB_OTHER_INTR;
1161         }
1162
1163         return 0;
1164 }
1165
1166 void
1167 rte_intr_efd_disable(struct rte_intr_handle *intr_handle)
1168 {
1169         uint32_t i;
1170         struct rte_epoll_event *rev;
1171
1172         for (i = 0; i < intr_handle->nb_efd; i++) {
1173                 rev = &intr_handle->elist[i];
1174                 if (rev->status == RTE_EPOLL_INVALID)
1175                         continue;
1176                 if (rte_epoll_ctl(rev->epfd, EPOLL_CTL_DEL, rev->fd, rev)) {
1177                         /* force free if the entry valid */
1178                         eal_epoll_data_safe_free(rev);
1179                         rev->status = RTE_EPOLL_INVALID;
1180                 }
1181         }
1182
1183         if (intr_handle->max_intr > intr_handle->nb_efd) {
1184                 for (i = 0; i < intr_handle->nb_efd; i++)
1185                         close(intr_handle->efds[i]);
1186         }
1187         intr_handle->nb_efd = 0;
1188         intr_handle->max_intr = 0;
1189 }
1190
1191 int
1192 rte_intr_dp_is_en(struct rte_intr_handle *intr_handle)
1193 {
1194         return !(!intr_handle->nb_efd);
1195 }
1196
1197 int
1198 rte_intr_allow_others(struct rte_intr_handle *intr_handle)
1199 {
1200         return !!(intr_handle->max_intr - intr_handle->nb_efd);
1201 }