1 | /* |
1 | /* |
2 | iom.C -- generic I/O multiplexor |
2 | iom.C -- generic I/O multiplexer |
3 | Copyright (C) 2003, 2004 Marc Lehmann <pcg@goof.com> |
3 | Copyright (C) 2003-2006 Marc Lehmann <gvpe@schmorp.de> |
4 | |
4 | |
|
|
5 | This file is part of GVPE. |
|
|
6 | |
5 | This program is free software; you can redistribute it and/or modify |
7 | GVPE is free software; you can redistribute it and/or modify |
6 | it under the terms of the GNU General Public License as published by |
8 | it under the terms of the GNU General Public License as published by |
7 | the Free Software Foundation; either version 2 of the License, or |
9 | the Free Software Foundation; either version 2 of the License, or |
8 | (at your option) any later version. |
10 | (at your option) any later version. |
9 | |
11 | |
10 | This program is distributed in the hope that it will be useful, |
12 | This program is distributed in the hope that it will be useful, |
11 | but WITHOUT ANY WARRANTY; without even the implied warranty of |
13 | but WITHOUT ANY WARRANTY; without even the implied warranty of |
12 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
14 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
13 | GNU General Public License for more details. |
15 | GNU General Public License for more details. |
14 | |
16 | |
15 | You should have received a copy of the GNU General Public License |
17 | You should have received a copy of the GNU General Public License |
16 | along with this program; if not, write to the Free Software |
18 | along with gvpe; if not, write to the Free Software |
17 | Foundation, Inc. 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
19 | Foundation, Inc. 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA |
18 | */ |
20 | */ |
19 | |
21 | |
20 | #include "iom.h" |
22 | #include "iom.h" |
21 | |
23 | |
22 | #include <cstdio> |
24 | #include <cstdio> |
23 | #include <cstdlib> |
25 | #include <cstdlib> |
24 | #include <cerrno> |
26 | #include <cerrno> |
|
|
27 | #include <cassert> |
25 | |
28 | |
|
|
29 | #include <sys/types.h> |
26 | #include <sys/time.h> |
30 | #include <sys/time.h> |
27 | |
|
|
28 | #include <assert.h> |
|
|
29 | |
31 | |
30 | #if 1 // older unices need these includes for select (2) |
32 | #if 1 // older unices need these includes for select (2) |
31 | # include <unistd.h> |
33 | # include <unistd.h> |
32 | # include <sys/types.h> |
|
|
33 | # include <time.h> |
34 | # include <time.h> |
34 | #endif |
35 | #endif |
35 | |
36 | |
36 | // for IOM_SIG |
37 | #if IOM_CHILD |
|
|
38 | # include <sys/wait.h> |
|
|
39 | #endif |
|
|
40 | |
37 | #if IOM_SIG |
41 | #if IOM_SIG |
38 | # include <signal.h> |
42 | # include <csignal> |
39 | # include <fcntl.h> |
43 | # include <fcntl.h> |
40 | #endif |
44 | #endif |
41 | |
45 | |
42 | // if the BSDs would at least be marginally POSIX-compatible.. *sigh* |
46 | // if the BSDs would at least be marginally POSIX-compatible.. *sigh* |
43 | // until that happens, sys/select.h must come last |
47 | // until that happens, sys/select.h must come last |
44 | #include <sys/select.h> |
48 | #include <sys/select.h> |
45 | |
|
|
46 | // TSTAMP_MAX must still fit into a positive struct timeval |
|
|
47 | #define TSTAMP_MAX (double)(1UL<<31) |
|
|
48 | |
49 | |
49 | #define TIMEVAL timeval |
50 | #define TIMEVAL timeval |
50 | #define TV_FRAC tv_usec |
51 | #define TV_FRAC tv_usec |
51 | #define TV_MULT 1000000L |
52 | #define TV_MULT 1000000L |
52 | |
53 | |
… | |
… | |
71 | : pending (false) |
72 | : pending (false) |
72 | { } |
73 | { } |
73 | }; |
74 | }; |
74 | static vector<sig_vec *> sw; |
75 | static vector<sig_vec *> sw; |
75 | #endif |
76 | #endif |
|
|
77 | #if IOM_CHILD |
|
|
78 | static io_manager_vec<child_watcher> pw; |
|
|
79 | #endif |
76 | |
80 | |
77 | // this is a dummy time watcher to ensure that the first |
81 | // this is a dummy time watcher to ensure that the first |
78 | // time watcher is _always_ valid, this gets rid of a lot |
82 | // time watcher is _always_ valid, this gets rid of a lot |
79 | // of null-pointer-checks |
83 | // of null-pointer-checks |
80 | // (must come _before_ iom is being defined) |
84 | // (must come _before_ iom is being defined) |
81 | static struct tw0 : time_watcher |
85 | static struct tw0 : time_watcher |
|
|
86 | { |
|
|
87 | void cb (time_watcher &w) |
82 | { |
88 | { |
83 | void cb (time_watcher &w) |
|
|
84 | { |
|
|
85 | // should never get called |
89 | // should never get called |
86 | // reached end-of-time, or tstamp has a bogus definition, |
90 | // reached end-of-time, or tstamp has a bogus definition, |
87 | // or compiler initialisation order broken, or something else :) |
91 | // or compiler initialisation order broken, or something else :) |
88 | abort (); |
92 | abort (); |
89 | } |
93 | } |
90 | |
94 | |
91 | tw0 () |
95 | tw0 () |
92 | : time_watcher (this, &tw0::cb) |
96 | : time_watcher (this, &tw0::cb) |
93 | { } |
97 | { } |
94 | } tw0; |
98 | } tw0; |
95 | |
99 | |
96 | tstamp NOW; |
100 | tstamp NOW; |
97 | |
101 | |
|
|
102 | #if IOM_CHILD |
|
|
103 | // sig_watcher for child signal(s) |
|
|
104 | static struct sw0 : sig_watcher |
|
|
105 | { |
|
|
106 | void cb (sig_watcher &w) |
|
|
107 | { |
|
|
108 | // SIGCHLD, call corresponding watchera |
|
|
109 | pid_t pid; |
|
|
110 | int status; |
|
|
111 | |
|
|
112 | while ((pid = waitpid (-1, &status, WNOHANG)) > 0) |
|
|
113 | for (int i = pw.size (); i--; ) |
|
|
114 | { |
|
|
115 | child_watcher *w = pw[i]; |
|
|
116 | |
|
|
117 | if (!w) |
|
|
118 | pw.erase_unordered (i); |
|
|
119 | else if (w->pid == pid) |
|
|
120 | { |
|
|
121 | io_manager::unreg (*w); |
|
|
122 | w->call (*w, status); |
|
|
123 | } |
|
|
124 | } |
|
|
125 | } |
|
|
126 | |
|
|
127 | sw0 () |
|
|
128 | : sig_watcher (this, &sw0::cb) |
|
|
129 | { } |
|
|
130 | } sw0; |
|
|
131 | #endif |
|
|
132 | |
98 | #if IOM_TIME |
133 | #if IOM_TIME |
99 | inline void set_now (void) |
134 | tstamp io_manager::now () |
100 | { |
135 | { |
101 | struct timeval tv; |
136 | struct timeval tv; |
102 | |
137 | |
103 | gettimeofday (&tv, 0); |
138 | gettimeofday (&tv, 0); |
104 | NOW = (tstamp)tv.tv_sec + (tstamp)tv.tv_usec / 1000000.; |
139 | return (tstamp)tv.tv_sec + (tstamp)tv.tv_usec / 1000000.; |
|
|
140 | } |
|
|
141 | |
|
|
142 | void io_manager::set_now () |
|
|
143 | { |
|
|
144 | NOW = now (); |
105 | } |
145 | } |
106 | #endif |
146 | #endif |
107 | |
147 | |
108 | static bool iom_valid; |
148 | static bool iom_valid; |
109 | |
149 | |
110 | // used for initialisation only |
150 | // used for initialisation only |
111 | static struct init { |
151 | static struct init { |
112 | init () |
152 | init () |
113 | { |
153 | { |
|
|
154 | iom_valid = true; |
|
|
155 | |
114 | #if IOM_SIG |
156 | #if IOM_SIG |
115 | sigemptyset (&sigs); |
157 | sigemptyset (&sigs); |
116 | |
158 | |
117 | if (pipe (sigpipe)) |
159 | if (pipe (sigpipe)) |
118 | { |
160 | { |
119 | perror ("io_manager: unable to create signal pipe, aborting."); |
161 | perror ("io_manager: unable to create signal pipe, aborting."); |
120 | abort (); |
162 | abort (); |
121 | } |
163 | } |
122 | |
164 | |
123 | fcntl (sigpipe[0], F_SETFL, O_NONBLOCK); |
165 | fcntl (sigpipe[0], F_SETFL, O_NONBLOCK); fcntl (sigpipe[0], F_SETFD, FD_CLOEXEC); |
124 | fcntl (sigpipe[1], F_SETFL, O_NONBLOCK); |
166 | fcntl (sigpipe[1], F_SETFL, O_NONBLOCK); fcntl (sigpipe[1], F_SETFD, FD_CLOEXEC); |
125 | #endif |
167 | #endif |
126 | |
168 | |
127 | iom_valid = true; |
169 | #if IOM_CHILD |
|
|
170 | sw0.start (SIGCHLD); |
|
|
171 | #endif |
128 | |
172 | |
129 | #if IOM_TIME |
173 | #if IOM_TIME |
130 | set_now (); |
174 | io_manager::set_now (); |
131 | |
175 | |
132 | tw0.start (TSTAMP_MAX); |
176 | tw0.start (TSTAMP_MAX); |
133 | #endif |
177 | #endif |
|
|
178 | } |
|
|
179 | |
|
|
180 | ~init () |
|
|
181 | { |
|
|
182 | iom_valid = false; |
134 | } |
183 | } |
135 | |
184 | |
136 | static void required (); |
185 | static void required (); |
137 | } init; |
186 | } init; |
138 | |
187 | |
… | |
… | |
152 | { |
201 | { |
153 | init::required (); |
202 | init::required (); |
154 | |
203 | |
155 | if (!w.active) |
204 | if (!w.active) |
156 | { |
205 | { |
157 | #if IOM_CHECK |
|
|
158 | queue.activity = true; |
|
|
159 | #endif |
|
|
160 | queue.push_back (&w); |
206 | queue.push_back (&w); |
161 | w.active = queue.size (); |
207 | w.active = queue.size (); |
162 | } |
208 | } |
163 | } |
209 | } |
164 | |
210 | |
… | |
… | |
213 | write (sigpipe[1], &ch, 1); |
259 | write (sigpipe[1], &ch, 1); |
214 | } |
260 | } |
215 | |
261 | |
216 | void io_manager::reg (sig_watcher &w) |
262 | void io_manager::reg (sig_watcher &w) |
217 | { |
263 | { |
|
|
264 | init::required (); |
|
|
265 | |
218 | assert (0 < w.signum); |
266 | assert (0 < w.signum); |
219 | |
267 | |
220 | sw.reserve (w.signum); |
268 | sw.reserve (w.signum); |
221 | |
269 | |
222 | while (sw.size () < w.signum) // pathetic |
270 | while (sw.size () < w.signum) // pathetic |
… | |
… | |
247 | io_manager::reg (w, *sv); |
295 | io_manager::reg (w, *sv); |
248 | } |
296 | } |
249 | |
297 | |
250 | void io_manager::unreg (sig_watcher &w) |
298 | void io_manager::unreg (sig_watcher &w) |
251 | { |
299 | { |
252 | if (!w.active) |
300 | if (!w.active || !iom_valid) |
253 | return; |
301 | return; |
254 | |
302 | |
255 | assert (0 < w.signum && w.signum <= sw.size ()); |
303 | assert (0 < w.signum && w.signum <= sw.size ()); |
256 | |
304 | |
257 | io_manager::unreg (w, *sw[w.signum - 1]); |
305 | io_manager::unreg (w, *sw[w.signum - 1]); |
… | |
… | |
263 | this->signum = signum; |
311 | this->signum = signum; |
264 | io_manager::reg (*this); |
312 | io_manager::reg (*this); |
265 | } |
313 | } |
266 | #endif |
314 | #endif |
267 | |
315 | |
|
|
316 | #if IOM_CHILD |
|
|
317 | void io_manager::reg (child_watcher &w) { io_manager::reg (w, pw); } |
|
|
318 | void io_manager::unreg (child_watcher &w) { io_manager::unreg (w, pw); } |
|
|
319 | #endif |
|
|
320 | |
268 | void io_manager::loop () |
321 | void io_manager::loop () |
269 | { |
322 | { |
270 | init::required (); |
323 | init::required (); |
271 | |
324 | |
272 | #if IOM_TIME |
325 | #if IOM_TIME |
273 | set_now (); |
326 | set_now (); |
274 | #endif |
327 | #endif |
275 | |
328 | |
276 | for (;;) |
329 | for (;;) |
277 | { |
330 | { |
|
|
331 | |
|
|
332 | #if IOM_TIME |
|
|
333 | // call pending time watchers |
|
|
334 | { |
|
|
335 | bool activity; |
|
|
336 | |
|
|
337 | do |
|
|
338 | { |
|
|
339 | activity = false; |
|
|
340 | |
|
|
341 | for (int i = tw.size (); i--; ) |
|
|
342 | if (!tw[i]) |
|
|
343 | tw.erase_unordered (i); |
|
|
344 | else if (tw[i]->at <= NOW) |
|
|
345 | { |
|
|
346 | time_watcher &w = *tw[i]; |
|
|
347 | |
|
|
348 | unreg (w); |
|
|
349 | w.call (w); |
|
|
350 | |
|
|
351 | activity = true; |
|
|
352 | } |
|
|
353 | } |
|
|
354 | while (activity); |
|
|
355 | } |
|
|
356 | #endif |
|
|
357 | |
|
|
358 | #if IOM_CHECK |
|
|
359 | // call all check watchers |
|
|
360 | for (int i = cw.size (); i--; ) |
|
|
361 | if (!cw[i]) |
|
|
362 | cw.erase_unordered (i); |
|
|
363 | else |
|
|
364 | cw[i]->call (*cw[i]); |
|
|
365 | #endif |
|
|
366 | |
278 | struct TIMEVAL *to = 0; |
367 | struct TIMEVAL *to = 0; |
279 | struct TIMEVAL tval; |
368 | struct TIMEVAL tval; |
280 | |
369 | |
281 | #if IOM_IDLE |
370 | #if IOM_IDLE |
282 | if (iw.size ()) |
371 | if (iw.size ()) |
… | |
… | |
287 | } |
376 | } |
288 | else |
377 | else |
289 | #endif |
378 | #endif |
290 | { |
379 | { |
291 | #if IOM_TIME |
380 | #if IOM_TIME |
292 | time_watcher *next; |
381 | // find earliest active watcher |
|
|
382 | time_watcher *next = tw[0]; // the first time-watcher must exist at ALL times |
293 | |
383 | |
294 | for (;;) |
384 | for (io_manager_vec<time_watcher>::const_iterator i = tw.end (); i-- > tw.begin (); ) |
|
|
385 | if (*i && (*i)->at < next->at) |
|
|
386 | next = *i; |
|
|
387 | |
|
|
388 | if (next->at > NOW && next != tw[0]) |
295 | { |
389 | { |
296 | next = tw[0]; // the first time-watcher must exist at ALL times |
|
|
297 | |
|
|
298 | for (int i = tw.size (); i--; ) |
|
|
299 | if (!tw[i]) |
|
|
300 | tw.erase_unordered (i); |
|
|
301 | else if (tw[i]->at < next->at) |
|
|
302 | next = tw[i]; |
|
|
303 | |
|
|
304 | if (next->at > NOW) |
|
|
305 | { |
|
|
306 | if (next != tw[0]) |
|
|
307 | { |
|
|
308 | double diff = next->at - NOW; |
390 | double diff = next->at - NOW; |
309 | tval.tv_sec = (int)diff; |
391 | tval.tv_sec = (int)diff; |
310 | tval.TV_FRAC = (int) ((diff - tval.tv_sec) * TV_MULT); |
392 | tval.TV_FRAC = (int) ((diff - tval.tv_sec) * TV_MULT); |
311 | to = &tval; |
393 | to = &tval; |
312 | } |
|
|
313 | break; |
|
|
314 | } |
|
|
315 | else |
|
|
316 | { |
|
|
317 | unreg (*next); |
|
|
318 | next->call (*next); |
|
|
319 | } |
|
|
320 | } |
394 | } |
321 | #endif |
|
|
322 | } |
|
|
323 | |
|
|
324 | #if IOM_CHECK |
|
|
325 | tw.activity = false; |
|
|
326 | |
|
|
327 | for (int i = cw.size (); i--; ) |
|
|
328 | if (!cw[i]) |
|
|
329 | cw.erase_unordered (i); |
|
|
330 | else |
|
|
331 | cw[i]->call (*cw[i]); |
|
|
332 | |
|
|
333 | if (tw.activity) |
|
|
334 | { |
|
|
335 | tval.tv_sec = 0; |
|
|
336 | tval.TV_FRAC = 0; |
|
|
337 | to = &tval; |
|
|
338 | } |
395 | } |
339 | #endif |
396 | #endif |
340 | |
397 | |
341 | #if IOM_IO || IOM_SIG |
398 | #if IOM_IO || IOM_SIG |
342 | fd_set rfd, wfd; |
399 | fd_set rfd, wfd; |
… | |
… | |
345 | FD_ZERO (&wfd); |
402 | FD_ZERO (&wfd); |
346 | |
403 | |
347 | int fds = 0; |
404 | int fds = 0; |
348 | |
405 | |
349 | # if IOM_IO |
406 | # if IOM_IO |
350 | for (io_manager_vec<io_watcher>::iterator i = iow.end (); i-- > iow.begin (); ) |
407 | for (io_manager_vec<io_watcher>::const_iterator i = iow.end (); i-- > iow.begin (); ) |
351 | if (*i) |
408 | if (*i) |
352 | { |
409 | { |
353 | if ((*i)->events & EVENT_READ ) FD_SET ((*i)->fd, &rfd); |
410 | if ((*i)->events & EVENT_READ ) FD_SET ((*i)->fd, &rfd); |
354 | if ((*i)->events & EVENT_WRITE) FD_SET ((*i)->fd, &wfd); |
411 | if ((*i)->events & EVENT_WRITE) FD_SET ((*i)->fd, &wfd); |
355 | |
412 | |
356 | if ((*i)->fd >= fds) fds = (*i)->fd + 1; |
413 | if ((*i)->fd >= fds) fds = (*i)->fd + 1; |
357 | } |
414 | } |
358 | # endif |
415 | # endif |
359 | |
416 | |
360 | if (!to && !fds) //TODO: also check idle_watchers and check_watchers |
417 | if (!to && !fds) //TODO: also check idle_watchers and check_watchers? |
361 | break; // no events |
418 | break; // no events |
362 | |
419 | |
363 | # if IOM_SIG |
420 | # if IOM_SIG |
364 | FD_SET (sigpipe[0], &rfd); |
421 | FD_SET (sigpipe[0], &rfd); |
365 | if (sigpipe[0] >= fds) fds = sigpipe[0] + 1; |
422 | if (sigpipe[0] >= fds) fds = sigpipe[0] + 1; |
… | |
… | |
374 | # if IOM_SIG |
431 | # if IOM_SIG |
375 | sigprocmask (SIG_BLOCK, &sigs, NULL); |
432 | sigprocmask (SIG_BLOCK, &sigs, NULL); |
376 | # endif |
433 | # endif |
377 | |
434 | |
378 | # if IOM_TIME |
435 | # if IOM_TIME |
|
|
436 | { |
|
|
437 | // update time, try to compensate for gross non-monotonic time changes |
|
|
438 | tstamp diff = NOW; |
379 | set_now (); |
439 | set_now (); |
|
|
440 | diff = NOW - diff; |
|
|
441 | |
|
|
442 | if (diff < 0) |
|
|
443 | for (io_manager_vec<time_watcher>::const_iterator i = tw.end (); i-- > tw.begin (); ) |
|
|
444 | if (*i) |
|
|
445 | (*i)->at += diff; |
|
|
446 | } |
380 | # endif |
447 | # endif |
381 | |
448 | |
382 | if (fds > 0) |
449 | if (fds > 0) |
383 | { |
450 | { |
384 | # if IOM_SIG |
451 | # if IOM_SIG |
… | |
… | |
387 | char ch; |
454 | char ch; |
388 | |
455 | |
389 | while (read (sigpipe[0], &ch, 1) > 0) |
456 | while (read (sigpipe[0], &ch, 1) > 0) |
390 | ; |
457 | ; |
391 | |
458 | |
392 | for (sig_vec **svp = sw.end (); svp-- > sw.begin (); ) |
459 | for (vector<sig_vec *>::iterator svp = sw.end (); svp-- > sw.begin (); ) |
393 | if (*svp && (*svp)->pending) |
460 | if (*svp && (*svp)->pending) |
394 | { |
461 | { |
395 | sig_vec &sv = **svp; |
462 | sig_vec &sv = **svp; |
396 | for (int i = sv.size (); i--; ) |
463 | for (int i = sv.size (); i--; ) |
397 | if (!sv[i]) |
464 | if (!sv[i]) |
… | |
… | |
408 | for (int i = iow.size (); i--; ) |
475 | for (int i = iow.size (); i--; ) |
409 | if (!iow[i]) |
476 | if (!iow[i]) |
410 | iow.erase_unordered (i); |
477 | iow.erase_unordered (i); |
411 | else |
478 | else |
412 | { |
479 | { |
|
|
480 | io_watcher &w = *iow[i]; |
413 | short revents = iow[i]->events; |
481 | short revents = w.events; |
414 | |
482 | |
415 | if (!FD_ISSET (iow[i]->fd, &rfd)) revents &= ~EVENT_READ; |
483 | if (!FD_ISSET (w.fd, &rfd)) revents &= ~EVENT_READ; |
416 | if (!FD_ISSET (iow[i]->fd, &wfd)) revents &= ~EVENT_WRITE; |
484 | if (!FD_ISSET (w.fd, &wfd)) revents &= ~EVENT_WRITE; |
417 | |
485 | |
418 | if (revents) |
486 | if (revents) |
419 | iow[i]->call (*iow[i], revents); |
487 | w.call (w, revents); |
420 | } |
488 | } |
421 | #endif |
489 | #endif |
422 | } |
490 | } |
423 | else if (fds < 0 && errno != EINTR) |
491 | else if (fds < 0 && errno != EINTR) |
424 | { |
492 | { |