1 | /* |
1 | /* |
|
|
2 | * libev select fd activity backend |
|
|
3 | * |
2 | * Copyright (c) 2007 Marc Alexander Lehmann <libev@schmorp.de> |
4 | * Copyright (c) 2007 Marc Alexander Lehmann <libev@schmorp.de> |
3 | * All rights reserved. |
5 | * All rights reserved. |
4 | * |
6 | * |
5 | * Redistribution and use in source and binary forms, with or without |
7 | * Redistribution and use in source and binary forms, with or without |
6 | * modification, are permitted provided that the following conditions are |
8 | * modification, are permitted provided that the following conditions are |
… | |
… | |
25 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
27 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
26 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
28 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
27 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
29 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
28 | */ |
30 | */ |
29 | |
31 | |
30 | /* for broken bsd's */ |
|
|
31 | #include <sys/time.h> |
|
|
32 | #include <sys/types.h> |
|
|
33 | #include <unistd.h> |
|
|
34 | |
|
|
35 | /* for unix systems */ |
32 | /* for unix systems */ |
|
|
33 | #if WIN32 |
|
|
34 | typedef unsigned int uint32_t; |
|
|
35 | # ifndef EV_SELECT_USE_FD_SET |
|
|
36 | # define EV_SELECT_USE_FD_SET 1 |
|
|
37 | # endif |
|
|
38 | #else |
36 | #include <sys/select.h> |
39 | # include <sys/select.h> |
|
|
40 | # include <inttypes.h> |
|
|
41 | #endif |
|
|
42 | |
|
|
43 | #if EV_SELECT_USE_WIN32_HANDLES |
|
|
44 | # undef EV_SELECT_USE_FD_SET |
|
|
45 | # define EV_SELECT_USE_FD_SET 1 |
|
|
46 | #else |
|
|
47 | #endif |
37 | |
48 | |
38 | #include <string.h> |
49 | #include <string.h> |
39 | #include <inttypes.h> |
|
|
40 | |
|
|
41 | static unsigned char *vec_ri, *vec_ro, *vec_wi, *vec_wo; |
|
|
42 | static int vec_max; |
|
|
43 | |
50 | |
44 | static void |
51 | static void |
45 | select_modify (int fd, int oev, int nev) |
52 | select_modify (EV_P_ int fd, int oev, int nev) |
46 | { |
53 | { |
|
|
54 | if (oev == nev) |
|
|
55 | return; |
|
|
56 | |
|
|
57 | #if EV_SELECT_USE_FD_SET |
|
|
58 | # if EV_SELECT_USE_WIN32_HANDLES |
|
|
59 | fd = _get_osfhandle (fd); |
|
|
60 | if (fd < 0) |
|
|
61 | return; |
|
|
62 | # endif |
|
|
63 | |
|
|
64 | if (nev & EV_READ) |
|
|
65 | FD_SET (fd, (struct fd_set *)vec_ri); |
|
|
66 | else |
|
|
67 | FD_CLR (fd, (struct fd_set *)vec_ri); |
|
|
68 | |
|
|
69 | if (nev & EV_WRITE) |
|
|
70 | FD_SET (fd, (struct fd_set *)vec_wi); |
|
|
71 | else |
|
|
72 | FD_CLR (fd, (struct fd_set *)vec_wi); |
|
|
73 | #else |
|
|
74 | { |
47 | int offs = fd >> 3; |
75 | int offs = fd >> 3; |
48 | int mask = 1 << (fd & 7); |
76 | int mask = 1 << (fd & 7); |
49 | |
77 | |
50 | if (vec_max < (fd >> 5) + 1) |
78 | if (vec_max < (fd >> 5) + 1) |
51 | { |
79 | { |
52 | vec_max = (fd >> 5) + 1; |
80 | int new_max = (fd >> 5) + 1; |
53 | |
81 | |
54 | vec_ri = (unsigned char *)realloc (vec_ri, vec_max * 4); |
82 | vec_ri = (unsigned char *)ev_realloc (vec_ri, new_max * 4); |
55 | vec_ro = (unsigned char *)realloc (vec_ro, vec_max * 4); /* could free/malloc */ |
83 | vec_ro = (unsigned char *)ev_realloc (vec_ro, new_max * 4); /* could free/malloc */ |
56 | vec_wi = (unsigned char *)realloc (vec_wi, vec_max * 4); |
84 | vec_wi = (unsigned char *)ev_realloc (vec_wi, new_max * 4); |
57 | vec_wo = (unsigned char *)realloc (vec_wo, vec_max * 4); /* could free/malloc */ |
85 | vec_wo = (unsigned char *)ev_realloc (vec_wo, new_max * 4); /* could free/malloc */ |
|
|
86 | |
|
|
87 | for (; vec_max < new_max; ++vec_max) |
|
|
88 | ((uint32_t *)vec_ri)[vec_max] = |
|
|
89 | ((uint32_t *)vec_wi)[vec_max] = 0; |
58 | } |
90 | } |
59 | |
91 | |
60 | vec_ri [offs] |= mask; |
92 | vec_ri [offs] |= mask; |
61 | if (!(nev & EV_READ)) |
93 | if (!(nev & EV_READ)) |
62 | vec_ri [offs] &= ~mask; |
94 | vec_ri [offs] &= ~mask; |
63 | |
95 | |
64 | vec_wi [offs] |= mask; |
96 | vec_wi [offs] |= mask; |
65 | if (!(nev & EV_WRITE)) |
97 | if (!(nev & EV_WRITE)) |
66 | vec_wi [offs] &= ~mask; |
98 | vec_wi [offs] &= ~mask; |
|
|
99 | } |
|
|
100 | #endif |
67 | } |
101 | } |
68 | |
102 | |
|
|
103 | static void |
69 | static void select_poll (ev_tstamp timeout) |
104 | select_poll (EV_P_ ev_tstamp timeout) |
70 | { |
105 | { |
|
|
106 | int word, offs; |
71 | struct timeval tv; |
107 | struct timeval tv; |
72 | int res; |
108 | int res; |
73 | |
109 | |
|
|
110 | #if EV_SELECT_USE_FD_SET |
|
|
111 | memcpy (vec_ro, vec_ri, sizeof (struct fd_set)); |
|
|
112 | memcpy (vec_wo, vec_wi, sizeof (struct fd_set)); |
|
|
113 | #else |
74 | memcpy (vec_ro, vec_ri, vec_max * 4); |
114 | memcpy (vec_ro, vec_ri, vec_max * 4); |
75 | memcpy (vec_wo, vec_wi, vec_max * 4); |
115 | memcpy (vec_wo, vec_wi, vec_max * 4); |
|
|
116 | #endif |
76 | |
117 | |
77 | tv.tv_sec = (long)timeout; |
118 | tv.tv_sec = (long)timeout; |
78 | tv.tv_usec = (long)((timeout - (ev_tstamp)tv.tv_sec) * 1e6); |
119 | tv.tv_usec = (long)((timeout - (ev_tstamp)tv.tv_sec) * 1e6); |
79 | |
120 | |
80 | res = select (vec_max * 32, (fd_set *)vec_ro, (fd_set *)vec_wo, 0, &tv); |
121 | res = select (vec_max * 32, (fd_set *)vec_ro, (fd_set *)vec_wo, 0, &tv); |
81 | |
122 | |
82 | if (res > 0) |
123 | if (res < 0) |
|
|
124 | { |
|
|
125 | #ifdef WIN32 |
|
|
126 | if (errno == WSAEINTR ) errno = EINTR; |
|
|
127 | if (errno == WSAENOTSOCK) errno = EBADF; |
|
|
128 | #endif |
|
|
129 | |
|
|
130 | if (errno == EBADF) |
|
|
131 | fd_ebadf (EV_A); |
|
|
132 | else if (errno == ENOMEM && !syserr_cb) |
|
|
133 | fd_enomem (EV_A); |
|
|
134 | else if (errno != EINTR) |
|
|
135 | syserr ("(libev) select"); |
|
|
136 | |
|
|
137 | return; |
83 | { |
138 | } |
84 | int word, offs; |
|
|
85 | |
139 | |
86 | for (word = vec_max; word--; ) |
140 | #if EV_SELECT_USE_FD_SET |
|
|
141 | # if EV_SELECT_USE_WIN32_HANDLES |
|
|
142 | for (word = 0; word < anfdmax; ++word) |
|
|
143 | { |
|
|
144 | if (!anfd [word].events) |
87 | { |
145 | { |
88 | if (((uint32_t *)vec_ro) [word] | ((uint32_t *)vec_wo) [word]) |
146 | int fd = _get_osfhandle (word); |
89 | for (offs = 4; offs--; ) |
147 | |
|
|
148 | if (fd >= 0) |
90 | { |
149 | { |
91 | int idx = word * 4 + offs; |
|
|
92 | unsigned char byte_r = vec_ro [idx]; |
|
|
93 | unsigned char byte_w = vec_wo [idx]; |
|
|
94 | int bit; |
|
|
95 | |
|
|
96 | if (byte_r | byte_w) |
|
|
97 | for (bit = 8; bit--; ) |
|
|
98 | { |
|
|
99 | int events = 0; |
150 | int events = 0; |
100 | events |= byte_r & (1 << bit) ? EV_READ : 0; |
|
|
101 | events |= byte_w & (1 << bit) ? EV_WRITE : 0; |
|
|
102 | |
151 | |
|
|
152 | if (FD_ISSET (fd, (struct fd_set *)vec_ro)) events |= EV_READ; |
|
|
153 | if (FD_ISSET (fd, (struct fd_set *)vec_wo)) events |= EV_WRITE; |
|
|
154 | |
103 | if (events) |
155 | if (events) |
104 | fd_event (idx * 8 + bit, events); |
156 | fd_event (EV_A_ word, events); |
105 | } |
|
|
106 | } |
157 | } |
107 | } |
158 | } |
108 | } |
159 | } |
109 | } |
160 | # else |
|
|
161 | for (word = 0; word < FD_SETSIZE; ++word) |
|
|
162 | { |
|
|
163 | int events = 0; |
|
|
164 | if (FD_ISSET (word, (struct fd_set *)vec_ro)) events |= EV_READ; |
|
|
165 | if (FD_ISSET (word, (struct fd_set *)vec_wo)) events |= EV_WRITE; |
110 | |
166 | |
|
|
167 | if (events) |
|
|
168 | fd_event (EV_A_ word, events); |
|
|
169 | } |
|
|
170 | # endif |
|
|
171 | #else |
|
|
172 | for (word = vec_max; word--; ) |
|
|
173 | { |
|
|
174 | if (((uint32_t *)vec_ro) [word] | ((uint32_t *)vec_wo) [word]) |
|
|
175 | for (offs = 4; offs--; ) |
|
|
176 | { |
|
|
177 | int idx = word * 4 + offs; |
|
|
178 | unsigned char byte_r = vec_ro [idx]; |
|
|
179 | unsigned char byte_w = vec_wo [idx]; |
|
|
180 | int bit; |
|
|
181 | |
|
|
182 | if (byte_r | byte_w) |
|
|
183 | for (bit = 8; bit--; ) |
|
|
184 | { |
|
|
185 | int events = 0; |
|
|
186 | events |= byte_r & (1 << bit) ? EV_READ : 0; |
|
|
187 | events |= byte_w & (1 << bit) ? EV_WRITE : 0; |
|
|
188 | |
|
|
189 | if (events) |
|
|
190 | fd_event (EV_A_ idx * 8 + bit, events); |
|
|
191 | } |
|
|
192 | } |
|
|
193 | } |
|
|
194 | #endif |
|
|
195 | } |
|
|
196 | |
|
|
197 | static int |
111 | void select_init (int flags) |
198 | select_init (EV_P_ int flags) |
112 | { |
199 | { |
113 | ev_method = EVMETHOD_SELECT; |
|
|
114 | method_fudge = 1e-2; /* needed to compensate for select returning early, very conservative */ |
200 | method_fudge = 1e-2; /* needed to compensate for select returning early, very conservative */ |
115 | method_modify = select_modify; |
201 | method_modify = select_modify; |
116 | method_poll = select_poll; |
202 | method_poll = select_poll; |
117 | } |
|
|
118 | |
203 | |
|
|
204 | #if EV_SELECT_USE_FD_SET |
|
|
205 | vec_max = FD_SETSIZE / 32; |
|
|
206 | vec_ri = ev_malloc (sizeof (struct fd_set)); FD_ZERO ((struct fd_set *)vec_ri); |
|
|
207 | vec_ro = ev_malloc (sizeof (struct fd_set)); |
|
|
208 | vec_wi = ev_malloc (sizeof (struct fd_set)); FD_ZERO ((struct fd_set *)vec_wi); |
|
|
209 | vec_wo = ev_malloc (sizeof (struct fd_set)); |
|
|
210 | #else |
|
|
211 | vec_max = 0; |
|
|
212 | vec_ri = 0; |
|
|
213 | vec_ri = 0; |
|
|
214 | vec_wo = 0; |
|
|
215 | vec_wo = 0; |
|
|
216 | #endif |
119 | |
217 | |
|
|
218 | return EVMETHOD_SELECT; |
|
|
219 | } |
|
|
220 | |
|
|
221 | static void |
|
|
222 | select_destroy (EV_P) |
|
|
223 | { |
|
|
224 | ev_free (vec_ri); |
|
|
225 | ev_free (vec_ro); |
|
|
226 | ev_free (vec_wi); |
|
|
227 | ev_free (vec_wo); |
|
|
228 | } |
|
|
229 | |
|
|
230 | |