|
|
1 | /* |
|
|
2 | * Copyright (c) 2007 Marc Alexander Lehmann <libev@schmorp.de> |
|
|
3 | * All rights reserved. |
|
|
4 | * |
|
|
5 | * Redistribution and use in source and binary forms, with or without |
|
|
6 | * modification, are permitted provided that the following conditions are |
|
|
7 | * met: |
|
|
8 | * |
|
|
9 | * * Redistributions of source code must retain the above copyright |
|
|
10 | * notice, this list of conditions and the following disclaimer. |
|
|
11 | * |
|
|
12 | * * Redistributions in binary form must reproduce the above |
|
|
13 | * copyright notice, this list of conditions and the following |
|
|
14 | * disclaimer in the documentation and/or other materials provided |
|
|
15 | * with the distribution. |
|
|
16 | * |
|
|
17 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
|
|
18 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
|
|
19 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR |
|
|
20 | * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT |
|
|
21 | * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, |
|
|
22 | * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT |
|
|
23 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
|
|
24 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
|
|
25 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
|
|
26 | * (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. |
|
|
28 | */ |
|
|
29 | |
|
|
30 | /* for broken bsd's */ |
|
|
31 | #include <sys/time.h> |
|
|
32 | #include <sys/types.h> |
|
|
33 | #include <unistd.h> |
|
|
34 | |
|
|
35 | /* for unix systems */ |
|
|
36 | #include <sys/select.h> |
|
|
37 | |
|
|
38 | #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 | |
|
|
44 | static void |
|
|
45 | select_modify (int fd, int oev, int nev) |
|
|
46 | { |
|
|
47 | int offs = fd >> 3; |
|
|
48 | int mask = 1 << (fd & 7); |
|
|
49 | |
|
|
50 | if (vec_max < (fd >> 5) + 1) |
|
|
51 | { |
|
|
52 | vec_max = (fd >> 5) + 1; |
|
|
53 | |
|
|
54 | vec_ri = (unsigned char *)realloc (vec_ri, vec_max * 4); |
|
|
55 | vec_ro = (unsigned char *)realloc (vec_ro, vec_max * 4); /* could free/malloc */ |
|
|
56 | vec_wi = (unsigned char *)realloc (vec_wi, vec_max * 4); |
|
|
57 | vec_wo = (unsigned char *)realloc (vec_wo, vec_max * 4); /* could free/malloc */ |
|
|
58 | } |
|
|
59 | |
|
|
60 | vec_ri [offs] |= mask; |
|
|
61 | if (!(nev & EV_READ)) |
|
|
62 | vec_ri [offs] &= ~mask; |
|
|
63 | |
|
|
64 | vec_wi [offs] |= mask; |
|
|
65 | if (!(nev & EV_WRITE)) |
|
|
66 | vec_wi [offs] &= ~mask; |
|
|
67 | } |
|
|
68 | |
|
|
69 | static void select_poll (ev_tstamp timeout) |
|
|
70 | { |
|
|
71 | struct timeval tv; |
|
|
72 | int res; |
|
|
73 | |
|
|
74 | memcpy (vec_ro, vec_ri, vec_max * 4); |
|
|
75 | memcpy (vec_wo, vec_wi, vec_max * 4); |
|
|
76 | |
|
|
77 | tv.tv_sec = (long)timeout; |
|
|
78 | tv.tv_usec = (long)((timeout - (ev_tstamp)tv.tv_sec) * 1e6); |
|
|
79 | |
|
|
80 | res = select (vec_max * 32, (fd_set *)vec_ro, (fd_set *)vec_wo, 0, &tv); |
|
|
81 | |
|
|
82 | if (res > 0) |
|
|
83 | { |
|
|
84 | int word, offs; |
|
|
85 | |
|
|
86 | for (word = vec_max; word--; ) |
|
|
87 | { |
|
|
88 | if (((uint32_t *)vec_ro) [word] | ((uint32_t *)vec_wo) [word]) |
|
|
89 | for (offs = 4; offs--; ) |
|
|
90 | { |
|
|
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; |
|
|
100 | events |= byte_r & (1 << bit) ? EV_READ : 0; |
|
|
101 | events |= byte_w & (1 << bit) ? EV_WRITE : 0; |
|
|
102 | |
|
|
103 | if (events) |
|
|
104 | fd_event (idx * 8 + bit, events); |
|
|
105 | } |
|
|
106 | } |
|
|
107 | } |
|
|
108 | } |
|
|
109 | } |
|
|
110 | |
|
|
111 | void select_init (int flags) |
|
|
112 | { |
|
|
113 | ev_method = EVMETHOD_SELECT; |
|
|
114 | method_fudge = 1e-2; /* needed to compensate for select returning early, very conservative */ |
|
|
115 | method_modify = select_modify; |
|
|
116 | method_poll = select_poll; |
|
|
117 | } |
|
|
118 | |
|
|
119 | |