Commit | Line | Data |
---|---|---|
63ae2a94 | 1 | /* |
fee64d3c | 2 | * Copyright (C) 2000 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com) |
63ae2a94 JD |
3 | * Licensed under the GPL |
4 | */ | |
5 | ||
6 | #include <stdlib.h> | |
63ae2a94 | 7 | #include <errno.h> |
fee64d3c | 8 | #include <poll.h> |
63ae2a94 JD |
9 | #include <signal.h> |
10 | #include <string.h> | |
63ae2a94 | 11 | #include "irq_user.h" |
fee64d3c | 12 | #include "kern_constants.h" |
63ae2a94 | 13 | #include "os.h" |
fee64d3c | 14 | #include "process.h" |
c13e5690 | 15 | #include "um_malloc.h" |
fee64d3c | 16 | #include "user.h" |
63ae2a94 | 17 | |
f2e62992 JD |
18 | /* |
19 | * Locked by irq_lock in arch/um/kernel/irq.c. Changed by os_create_pollfd | |
20 | * and os_free_irq_by_cb, which are called under irq_lock. | |
21 | */ | |
63ae2a94 JD |
22 | static struct pollfd *pollfds = NULL; |
23 | static int pollfds_num = 0; | |
24 | static int pollfds_size = 0; | |
25 | ||
26 | int os_waiting_for_events(struct irq_fd *active_fds) | |
27 | { | |
28 | struct irq_fd *irq_fd; | |
29 | int i, n, err; | |
30 | ||
31 | n = poll(pollfds, pollfds_num, 0); | |
191ef966 | 32 | if (n < 0) { |
63ae2a94 | 33 | err = -errno; |
191ef966 | 34 | if (errno != EINTR) |
fee64d3c | 35 | printk(UM_KERN_ERR "os_waiting_for_events:" |
63ae2a94 JD |
36 | " poll returned %d, errno = %d\n", n, errno); |
37 | return err; | |
38 | } | |
39 | ||
191ef966 | 40 | if (n == 0) |
63ae2a94 JD |
41 | return 0; |
42 | ||
43 | irq_fd = active_fds; | |
44 | ||
191ef966 JJ |
45 | for (i = 0; i < pollfds_num; i++) { |
46 | if (pollfds[i].revents != 0) { | |
63ae2a94 JD |
47 | irq_fd->current_events = pollfds[i].revents; |
48 | pollfds[i].fd = -1; | |
49 | } | |
50 | irq_fd = irq_fd->next; | |
51 | } | |
52 | return n; | |
53 | } | |
54 | ||
63ae2a94 JD |
55 | int os_create_pollfd(int fd, int events, void *tmp_pfd, int size_tmpfds) |
56 | { | |
57 | if (pollfds_num == pollfds_size) { | |
58 | if (size_tmpfds <= pollfds_size * sizeof(pollfds[0])) { | |
59 | /* return min size needed for new pollfds area */ | |
f2e62992 | 60 | return (pollfds_size + 1) * sizeof(pollfds[0]); |
63ae2a94 JD |
61 | } |
62 | ||
191ef966 | 63 | if (pollfds != NULL) { |
63ae2a94 JD |
64 | memcpy(tmp_pfd, pollfds, |
65 | sizeof(pollfds[0]) * pollfds_size); | |
66 | /* remove old pollfds */ | |
67 | kfree(pollfds); | |
68 | } | |
69 | pollfds = tmp_pfd; | |
70 | pollfds_size++; | |
191ef966 JJ |
71 | } else |
72 | kfree(tmp_pfd); /* remove not used tmp_pfd */ | |
63ae2a94 | 73 | |
191ef966 JJ |
74 | pollfds[pollfds_num] = ((struct pollfd) { .fd = fd, |
75 | .events = events, | |
76 | .revents = 0 }); | |
63ae2a94 JD |
77 | pollfds_num++; |
78 | ||
191ef966 | 79 | return 0; |
63ae2a94 JD |
80 | } |
81 | ||
82 | void os_free_irq_by_cb(int (*test)(struct irq_fd *, void *), void *arg, | |
83 | struct irq_fd *active_fds, struct irq_fd ***last_irq_ptr2) | |
84 | { | |
85 | struct irq_fd **prev; | |
86 | int i = 0; | |
87 | ||
88 | prev = &active_fds; | |
191ef966 JJ |
89 | while (*prev != NULL) { |
90 | if ((*test)(*prev, arg)) { | |
63ae2a94 | 91 | struct irq_fd *old_fd = *prev; |
191ef966 JJ |
92 | if ((pollfds[i].fd != -1) && |
93 | (pollfds[i].fd != (*prev)->fd)) { | |
fee64d3c JD |
94 | printk(UM_KERN_ERR "os_free_irq_by_cb - " |
95 | "mismatch between active_fds and " | |
96 | "pollfds, fd %d vs %d\n", | |
63ae2a94 JD |
97 | (*prev)->fd, pollfds[i].fd); |
98 | goto out; | |
99 | } | |
100 | ||
101 | pollfds_num--; | |
102 | ||
fee64d3c JD |
103 | /* |
104 | * This moves the *whole* array after pollfds[i] | |
63ae2a94 JD |
105 | * (though it doesn't spot as such)! |
106 | */ | |
63ae2a94 JD |
107 | memmove(&pollfds[i], &pollfds[i + 1], |
108 | (pollfds_num - i) * sizeof(pollfds[0])); | |
fee64d3c | 109 | if (*last_irq_ptr2 == &old_fd->next) |
63ae2a94 JD |
110 | *last_irq_ptr2 = prev; |
111 | ||
112 | *prev = (*prev)->next; | |
fee64d3c | 113 | if (old_fd->type == IRQ_WRITE) |
63ae2a94 JD |
114 | ignore_sigio_fd(old_fd->fd); |
115 | kfree(old_fd); | |
116 | continue; | |
117 | } | |
118 | prev = &(*prev)->next; | |
119 | i++; | |
120 | } | |
121 | out: | |
122 | return; | |
123 | } | |
124 | ||
63ae2a94 JD |
125 | int os_get_pollfd(int i) |
126 | { | |
191ef966 | 127 | return pollfds[i].fd; |
63ae2a94 JD |
128 | } |
129 | ||
130 | void os_set_pollfd(int i, int fd) | |
131 | { | |
132 | pollfds[i].fd = fd; | |
133 | } | |
134 | ||
135 | void os_set_ioignore(void) | |
136 | { | |
4b84c69b | 137 | signal(SIGIO, SIG_IGN); |
63ae2a94 | 138 | } |