lib: Added mblock support for kqueue.
[ashd.git] / lib / mtio-epoll.c
1 /*
2     ashd - A Sane HTTP Daemon
3     Copyright (C) 2008  Fredrik Tolf <fredrik@dolda2000.com>
4
5     This program is free software: you can redistribute it and/or modify
6     it under the terms of the GNU General Public License as published by
7     the Free Software Foundation, either version 3 of the License, or
8     (at your option) any later version.
9
10     This program is distributed in the hope that it will be useful,
11     but WITHOUT ANY WARRANTY; without even the implied warranty of
12     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13     GNU General Public License for more details.
14
15     You should have received a copy of the GNU General Public License
16     along with this program.  If not, see <http://www.gnu.org/licenses/>.
17 */
18
19 #include <stdlib.h>
20 #include <unistd.h>
21 #include <time.h>
22 #include <fcntl.h>
23 #include <string.h>
24 #include <sys/epoll.h>
25 #include <errno.h>
26
27 #ifdef HAVE_CONFIG_H
28 #include <config.h>
29 #endif
30 #include <log.h>
31 #include <utils.h>
32 #include <mt.h>
33 #include <mtio.h>
34
35 static struct blocker *blockers;
36
37 struct blocker {
38     struct blocker *n, *p, *n2, *p2;
39     int fd, reg;
40     int ev, rev, id;
41     time_t to;
42     struct muth *th;
43 };
44
45 static int epfd = -1, fdln = 0;
46 static int exitstatus;
47 static struct blocker **fdlist;
48
49 static int regfd(struct blocker *bl)
50 {
51     struct blocker *o;
52     struct epoll_event evd;
53     
54     memset(&evd, 0, sizeof(evd));
55     evd.events = 0;
56     if(bl->ev & EV_READ)
57         evd.events |= EPOLLIN;
58     if(bl->ev & EV_WRITE)
59         evd.events |= EPOLLOUT;
60     evd.data.fd = bl->fd;
61     if(bl->fd >= fdln) {
62         if(fdlist) {
63             fdlist = srealloc(fdlist, sizeof(*fdlist) * (bl->fd + 1));
64             memset(fdlist + fdln, 0, sizeof(*fdlist) * (bl->fd + 1 - fdln));
65             fdln = bl->fd + 1;
66         } else {
67             fdlist = szmalloc(sizeof(*fdlist) * (fdln = (bl->fd + 1)));
68         }
69     }
70     if(fdlist[bl->fd] == NULL) {
71         if(epoll_ctl(epfd, EPOLL_CTL_ADD, bl->fd, &evd)) {
72             /* XXX?! Whatever to do, really? */
73             flog(LOG_ERR, "epoll_add on fd %i: %s", bl->fd, strerror(errno));
74             return(-1);
75         }
76     } else {
77         for(o = fdlist[bl->fd]; o; o = o->n2) {
78             if(o->ev & EV_READ)
79                 evd.events |= EPOLLIN;
80             if(o->ev & EV_WRITE)
81                 evd.events |= EPOLLOUT;
82         }
83         if(epoll_ctl(epfd, EPOLL_CTL_MOD, bl->fd, &evd)) {
84             /* XXX?! Whatever to do, really? */
85             flog(LOG_ERR, "epoll_mod on fd %i: %s", bl->fd, strerror(errno));
86             return(-1);
87         }
88     }
89     bl->n2 = fdlist[bl->fd];
90     bl->p2 = NULL;
91     if(fdlist[bl->fd] != NULL)
92         fdlist[bl->fd]->p2 = bl;
93     fdlist[bl->fd] = bl;
94     bl->reg = 1;
95     return(0);
96 }
97
98 static void remfd(struct blocker *bl)
99 {
100     struct blocker *o;
101     struct epoll_event evd;
102     
103     if(!bl->reg)
104         return;
105     if(bl->n2)
106         bl->n2->p2 = bl->p2;
107     if(bl->p2)
108         bl->p2->n2 = bl->n2;
109     if(bl == fdlist[bl->fd])
110         fdlist[bl->fd] = bl->n2;
111     if(fdlist[bl->fd] == NULL) {
112         if(epoll_ctl(epfd, EPOLL_CTL_DEL, bl->fd, NULL))
113             flog(LOG_ERR, "epoll_del on fd %i: %s", bl->fd, strerror(errno));
114     } else {
115         memset(&evd, 0, sizeof(evd));
116         evd.events = 0;
117         evd.data.fd = bl->fd;
118         for(o = fdlist[bl->fd]; o; o = o->n2) {
119             if(o->ev & EV_READ)
120                 evd.events |= EPOLLIN;
121             if(o->ev & EV_WRITE)
122                 evd.events |= EPOLLOUT;
123         }
124         if(epoll_ctl(epfd, EPOLL_CTL_MOD, bl->fd, &evd)) {
125             /* XXX?! Whatever to do, really? */
126             flog(LOG_ERR, "epoll_mod on fd %i: %s", bl->fd, strerror(errno));
127         }
128     }
129     bl->reg = 0;
130 }
131
132 static int addblock(struct blocker *bl)
133 {
134     if((epfd >= 0) && regfd(bl))
135         return(-1);
136     bl->n = blockers;
137     if(blockers)
138         blockers->p = bl;
139     blockers = bl;
140     return(0);
141 }
142
143 static void remblock(struct blocker *bl)
144 {
145     if(bl->n)
146         bl->n->p = bl->p;
147     if(bl->p)
148         bl->p->n = bl->n;
149     if(blockers == bl)
150         blockers = bl->n;
151     remfd(bl);
152 }
153
154 struct selected mblock(time_t to, int n, struct selected *spec)
155 {
156     int i, id;
157     struct blocker bls[n];
158     
159     to = (to > 0)?(time(NULL) + to):0;
160     for(i = 0; i < n; i++) {
161         bls[i] = (struct blocker) {
162             .fd = spec[i].fd,
163             .ev = spec[i].ev,
164             .id = i,
165             .to = to,
166             .th = current,
167         };
168         if(addblock(&bls[i])) {
169             for(i--; i >= 0; i++)
170                 remblock(&bls[i]);
171             return((struct selected){.fd = -1, .ev = -1});
172         }
173     }
174     id = yield();
175     for(i = 0; i < n; i++)
176         remblock(&bls[i]);
177     if(id < 0)
178         return((struct selected){.fd = -1, .ev = -1});
179     return((struct selected){.fd = bls[id].fd, .ev = bls[id].rev});
180 }
181
182 int block(int fd, int ev, time_t to)
183 {
184     struct blocker bl;
185     int rv;
186     
187     bl = (struct blocker) {
188         .fd = fd,
189         .ev = ev,
190         .id = -1,
191         .to = (to > 0)?(time(NULL) + to):0,
192         .th = current,
193     };
194     if(addblock(&bl))
195         return(-1);
196     rv = yield();
197     remblock(&bl);
198     return(rv);
199 }
200
201 int ioloop(void)
202 {
203     struct blocker *bl, *nbl;
204     struct epoll_event evr[16];
205     int i, fd, nev, ev, toval;
206     time_t now, timeout;
207     
208     exitstatus = 0;
209     epfd = epoll_create(128);
210     fcntl(epfd, F_SETFD, FD_CLOEXEC);
211     for(bl = blockers; bl; bl = nbl) {
212         nbl = bl->n;
213         if(regfd(bl))
214             resume(bl->th, -1);
215     }
216     while(blockers != NULL) {
217         timeout = 0;
218         for(bl = blockers; bl; bl = bl->n) {
219             if((bl->to != 0) && ((timeout == 0) || (timeout > bl->to)))
220                 timeout = bl->to;
221         }
222         now = time(NULL);
223         if(timeout == 0)
224             toval = -1;
225         else if(timeout > now)
226             toval = (timeout - now) * 1000;
227         else
228             toval = 1000;
229         if(exitstatus)
230             break;
231         nev = epoll_wait(epfd, evr, sizeof(evr) / sizeof(*evr), toval);
232         if(nev < 0) {
233             if(errno != EINTR) {
234                 flog(LOG_CRIT, "ioloop: epoll_wait errored out: %s", strerror(errno));
235                 /* To avoid CPU hogging in case it's bad, which it
236                  * probably is. */
237                 sleep(1);
238             }
239             continue;
240         }
241         for(i = 0; i < nev; i++) {
242             fd = evr[i].data.fd;
243             ev = 0;
244             if(evr[i].events & EPOLLIN)
245                 ev |= EV_READ;
246             if(evr[i].events & EPOLLOUT)
247                 ev |= EV_WRITE;
248             if(evr[i].events & ~(EPOLLIN | EPOLLOUT))
249                 ev = -1;
250             for(bl = fdlist[fd]; bl; bl = nbl) {
251                 nbl = bl->n2;
252                 if((ev < 0) || (ev & bl->ev)) {
253                     if(bl->id < 0) {
254                         resume(bl->th, ev);
255                     } else {
256                         bl->rev = ev;
257                         resume(bl->th, bl->id);
258                     }
259                 }
260             }
261         }
262         now = time(NULL);
263         for(bl = blockers; bl; bl = nbl) {
264             nbl = bl->n;
265             if((bl->to != 0) && (bl->to <= now)) {
266                 if(bl->id < 0) {
267                     resume(bl->th, 0);
268                 } else {
269                     bl->rev = 0;
270                     resume(bl->th, bl->id);
271                 }
272             }
273         }
274     }
275     for(bl = blockers; bl; bl = bl->n)
276         remfd(bl);
277     close(epfd);
278     epfd = -1;
279     return(exitstatus);
280 }
281
282 void exitioloop(int status)
283 {
284     exitstatus = status;
285 }