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 | #ifdef WIN32 |
|
|
34 | typedef unsigned int uint32_t; |
|
|
35 | #else |
36 | #include <sys/select.h> |
36 | # include <sys/select.h> |
|
|
37 | # include <inttypes.h> |
|
|
38 | #endif |
37 | |
39 | |
38 | #include <string.h> |
40 | #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 | |
41 | |
44 | static void |
42 | static void |
45 | select_modify (int fd, int oev, int nev) |
43 | select_modify (EV_P_ int fd, int oev, int nev) |
46 | { |
44 | { |
47 | int offs = fd >> 3; |
45 | int offs = fd >> 3; |
48 | int mask = 1 << (fd & 7); |
46 | int mask = 1 << (fd & 7); |
|
|
47 | |
|
|
48 | if (oev == nev) |
|
|
49 | return; |
49 | |
50 | |
50 | if (vec_max < (fd >> 5) + 1) |
51 | if (vec_max < (fd >> 5) + 1) |
51 | { |
52 | { |
52 | int new_max = (fd >> 5) + 1; |
53 | int new_max = (fd >> 5) + 1; |
53 | |
54 | |
54 | vec_ri = (unsigned char *)realloc (vec_ri, new_max * 4); |
55 | vec_ri = (unsigned char *)ev_realloc (vec_ri, new_max * 4); |
55 | vec_ro = (unsigned char *)realloc (vec_ro, new_max * 4); /* could free/malloc */ |
56 | vec_ro = (unsigned char *)ev_realloc (vec_ro, new_max * 4); /* could free/malloc */ |
56 | vec_wi = (unsigned char *)realloc (vec_wi, new_max * 4); |
57 | vec_wi = (unsigned char *)ev_realloc (vec_wi, new_max * 4); |
57 | vec_wo = (unsigned char *)realloc (vec_wo, new_max * 4); /* could free/malloc */ |
58 | vec_wo = (unsigned char *)ev_realloc (vec_wo, new_max * 4); /* could free/malloc */ |
58 | |
59 | |
59 | for (; vec_max < new_max; ++vec_max) |
60 | for (; vec_max < new_max; ++vec_max) |
60 | ((uint32_t *)vec_ri)[vec_max] = |
61 | ((uint32_t *)vec_ri)[vec_max] = |
61 | ((uint32_t *)vec_wi)[vec_max] = 0; |
62 | ((uint32_t *)vec_wi)[vec_max] = 0; |
62 | } |
63 | } |
… | |
… | |
69 | if (!(nev & EV_WRITE)) |
70 | if (!(nev & EV_WRITE)) |
70 | vec_wi [offs] &= ~mask; |
71 | vec_wi [offs] &= ~mask; |
71 | } |
72 | } |
72 | |
73 | |
73 | static void |
74 | static void |
74 | select_poll (ev_tstamp timeout) |
75 | select_poll (EV_P_ ev_tstamp timeout) |
75 | { |
76 | { |
|
|
77 | int word, offs; |
76 | struct timeval tv; |
78 | struct timeval tv; |
77 | int res; |
79 | int res; |
78 | |
80 | |
79 | memcpy (vec_ro, vec_ri, vec_max * 4); |
81 | memcpy (vec_ro, vec_ri, vec_max * 4); |
80 | memcpy (vec_wo, vec_wi, vec_max * 4); |
82 | memcpy (vec_wo, vec_wi, vec_max * 4); |
… | |
… | |
82 | tv.tv_sec = (long)timeout; |
84 | tv.tv_sec = (long)timeout; |
83 | tv.tv_usec = (long)((timeout - (ev_tstamp)tv.tv_sec) * 1e6); |
85 | tv.tv_usec = (long)((timeout - (ev_tstamp)tv.tv_sec) * 1e6); |
84 | |
86 | |
85 | res = select (vec_max * 32, (fd_set *)vec_ro, (fd_set *)vec_wo, 0, &tv); |
87 | res = select (vec_max * 32, (fd_set *)vec_ro, (fd_set *)vec_wo, 0, &tv); |
86 | |
88 | |
87 | if (res > 0) |
89 | if (res < 0) |
88 | { |
|
|
89 | int word, offs; |
|
|
90 | |
|
|
91 | for (word = vec_max; word--; ) |
|
|
92 | { |
|
|
93 | if (((uint32_t *)vec_ro) [word] | ((uint32_t *)vec_wo) [word]) |
|
|
94 | for (offs = 4; offs--; ) |
|
|
95 | { |
|
|
96 | int idx = word * 4 + offs; |
|
|
97 | unsigned char byte_r = vec_ro [idx]; |
|
|
98 | unsigned char byte_w = vec_wo [idx]; |
|
|
99 | int bit; |
|
|
100 | |
|
|
101 | if (byte_r | byte_w) |
|
|
102 | for (bit = 8; bit--; ) |
|
|
103 | { |
|
|
104 | int events = 0; |
|
|
105 | events |= byte_r & (1 << bit) ? EV_READ : 0; |
|
|
106 | events |= byte_w & (1 << bit) ? EV_WRITE : 0; |
|
|
107 | |
|
|
108 | if (events) |
|
|
109 | fd_event (idx * 8 + bit, events); |
|
|
110 | } |
|
|
111 | } |
|
|
112 | } |
|
|
113 | } |
|
|
114 | else if (res < 0) |
|
|
115 | { |
90 | { |
116 | if (errno == EBADF) |
91 | if (errno == EBADF) |
117 | fd_recheck (); |
92 | fd_ebadf (EV_A); |
|
|
93 | else if (errno == ENOMEM && !syserr_cb) |
|
|
94 | fd_enomem (EV_A); |
|
|
95 | else if (errno != EINTR) |
|
|
96 | syserr ("(libev) select"); |
|
|
97 | |
|
|
98 | return; |
|
|
99 | } |
|
|
100 | |
|
|
101 | for (word = vec_max; word--; ) |
|
|
102 | { |
|
|
103 | if (((uint32_t *)vec_ro) [word] | ((uint32_t *)vec_wo) [word]) |
|
|
104 | for (offs = 4; offs--; ) |
|
|
105 | { |
|
|
106 | int idx = word * 4 + offs; |
|
|
107 | unsigned char byte_r = vec_ro [idx]; |
|
|
108 | unsigned char byte_w = vec_wo [idx]; |
|
|
109 | int bit; |
|
|
110 | |
|
|
111 | if (byte_r | byte_w) |
|
|
112 | for (bit = 8; bit--; ) |
|
|
113 | { |
|
|
114 | int events = 0; |
|
|
115 | events |= byte_r & (1 << bit) ? EV_READ : 0; |
|
|
116 | events |= byte_w & (1 << bit) ? EV_WRITE : 0; |
|
|
117 | |
|
|
118 | if (events) |
|
|
119 | fd_event (EV_A_ idx * 8 + bit, events); |
|
|
120 | } |
|
|
121 | } |
118 | } |
122 | } |
119 | } |
123 | } |
120 | |
124 | |
121 | static void |
125 | static int |
122 | select_init (int flags) |
126 | select_init (EV_P_ int flags) |
123 | { |
127 | { |
124 | ev_method = EVMETHOD_SELECT; |
|
|
125 | method_fudge = 1e-2; /* needed to compensate for select returning early, very conservative */ |
128 | method_fudge = 1e-2; /* needed to compensate for select returning early, very conservative */ |
126 | method_modify = select_modify; |
129 | method_modify = select_modify; |
127 | method_poll = select_poll; |
130 | method_poll = select_poll; |
|
|
131 | |
|
|
132 | vec_max = 0; |
|
|
133 | vec_ri = 0; |
|
|
134 | vec_ri = 0; |
|
|
135 | vec_wo = 0; |
|
|
136 | vec_wo = 0; |
|
|
137 | |
|
|
138 | return EVMETHOD_SELECT; |
128 | } |
139 | } |
129 | |
140 | |
|
|
141 | static void |
|
|
142 | select_destroy (EV_P) |
|
|
143 | { |
|
|
144 | ev_free (vec_ri); |
|
|
145 | ev_free (vec_ro); |
|
|
146 | ev_free (vec_wi); |
|
|
147 | ev_free (vec_wo); |
|
|
148 | } |
|
|
149 | |
|
|
150 | |