1 | /* |
1 | /* |
2 | iom.C -- generic I/O multiplexer |
2 | iom.C -- generic I/O multiplexer |
3 | Copyright (C) 2003, 2004 Marc Lehmann <pcg@goof.com> |
3 | Copyright (C) 2003, 2004 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 | w->stop (); |
|
|
122 | w->call (*w, status); |
|
|
123 | } |
|
|
124 | } |
|
|
125 | |
|
|
126 | } |
|
|
127 | |
|
|
128 | sw0 () |
|
|
129 | : sig_watcher (this, &sw0::cb) |
|
|
130 | { } |
|
|
131 | } sw0; |
|
|
132 | #endif |
|
|
133 | |
98 | #if IOM_TIME |
134 | #if IOM_TIME |
99 | inline void set_now (void) |
135 | tstamp io_manager::now () |
100 | { |
136 | { |
101 | struct timeval tv; |
137 | struct timeval tv; |
102 | |
138 | |
103 | gettimeofday (&tv, 0); |
139 | gettimeofday (&tv, 0); |
104 | NOW = (tstamp)tv.tv_sec + (tstamp)tv.tv_usec / 1000000.; |
140 | return (tstamp)tv.tv_sec + (tstamp)tv.tv_usec / 1000000.; |
|
|
141 | } |
|
|
142 | |
|
|
143 | void io_manager::set_now () |
|
|
144 | { |
|
|
145 | NOW = now (); |
105 | } |
146 | } |
106 | #endif |
147 | #endif |
107 | |
148 | |
108 | static bool iom_valid; |
149 | static bool iom_valid; |
109 | |
150 | |
110 | // used for initialisation only |
151 | // used for initialisation only |
111 | static struct init { |
152 | static struct init { |
112 | init () |
153 | init () |
113 | { |
154 | { |
|
|
155 | iom_valid = true; |
|
|
156 | |
114 | #if IOM_SIG |
157 | #if IOM_SIG |
115 | sigemptyset (&sigs); |
158 | sigemptyset (&sigs); |
116 | |
159 | |
117 | if (pipe (sigpipe)) |
160 | if (pipe (sigpipe)) |
118 | { |
161 | { |
119 | perror ("io_manager: unable to create signal pipe, aborting."); |
162 | perror ("io_manager: unable to create signal pipe, aborting."); |
120 | abort (); |
163 | abort (); |
121 | } |
164 | } |
122 | |
165 | |
123 | fcntl (sigpipe[0], F_SETFL, O_NONBLOCK); |
166 | fcntl (sigpipe[0], F_SETFL, O_NONBLOCK); fcntl (sigpipe[0], F_SETFD, FD_CLOEXEC); |
124 | fcntl (sigpipe[1], F_SETFL, O_NONBLOCK); |
167 | fcntl (sigpipe[1], F_SETFL, O_NONBLOCK); fcntl (sigpipe[1], F_SETFD, FD_CLOEXEC); |
125 | #endif |
168 | #endif |
126 | |
169 | |
127 | iom_valid = true; |
170 | #if IOM_CHILD |
|
|
171 | sw0.start (SIGCHLD); |
|
|
172 | #endif |
128 | |
173 | |
129 | #if IOM_TIME |
174 | #if IOM_TIME |
130 | set_now (); |
175 | io_manager::set_now (); |
131 | |
176 | |
132 | tw0.start (TSTAMP_MAX); |
177 | tw0.start (TSTAMP_MAX); |
133 | #endif |
178 | #endif |
|
|
179 | } |
|
|
180 | |
|
|
181 | ~init () |
|
|
182 | { |
|
|
183 | iom_valid = false; |
134 | } |
184 | } |
135 | |
185 | |
136 | static void required (); |
186 | static void required (); |
137 | } init; |
187 | } init; |
138 | |
188 | |
… | |
… | |
210 | write (sigpipe[1], &ch, 1); |
260 | write (sigpipe[1], &ch, 1); |
211 | } |
261 | } |
212 | |
262 | |
213 | void io_manager::reg (sig_watcher &w) |
263 | void io_manager::reg (sig_watcher &w) |
214 | { |
264 | { |
|
|
265 | init::required (); |
|
|
266 | |
215 | assert (0 < w.signum); |
267 | assert (0 < w.signum); |
216 | |
268 | |
217 | sw.reserve (w.signum); |
269 | sw.reserve (w.signum); |
218 | |
270 | |
219 | while (sw.size () < w.signum) // pathetic |
271 | while (sw.size () < w.signum) // pathetic |
… | |
… | |
244 | io_manager::reg (w, *sv); |
296 | io_manager::reg (w, *sv); |
245 | } |
297 | } |
246 | |
298 | |
247 | void io_manager::unreg (sig_watcher &w) |
299 | void io_manager::unreg (sig_watcher &w) |
248 | { |
300 | { |
249 | if (!w.active) |
301 | if (!w.active || !iom_valid) |
250 | return; |
302 | return; |
251 | |
303 | |
252 | assert (0 < w.signum && w.signum <= sw.size ()); |
304 | assert (0 < w.signum && w.signum <= sw.size ()); |
253 | |
305 | |
254 | io_manager::unreg (w, *sw[w.signum - 1]); |
306 | io_manager::unreg (w, *sw[w.signum - 1]); |
… | |
… | |
258 | { |
310 | { |
259 | stop (); |
311 | stop (); |
260 | this->signum = signum; |
312 | this->signum = signum; |
261 | io_manager::reg (*this); |
313 | io_manager::reg (*this); |
262 | } |
314 | } |
|
|
315 | #endif |
|
|
316 | |
|
|
317 | #if IOM_CHILD |
|
|
318 | void io_manager::reg (child_watcher &w) { io_manager::reg (w, pw); } |
|
|
319 | void io_manager::unreg (child_watcher &w) { io_manager::unreg (w, pw); } |
263 | #endif |
320 | #endif |
264 | |
321 | |
265 | void io_manager::loop () |
322 | void io_manager::loop () |
266 | { |
323 | { |
267 | init::required (); |
324 | init::required (); |
… | |
… | |
375 | # if IOM_SIG |
432 | # if IOM_SIG |
376 | sigprocmask (SIG_BLOCK, &sigs, NULL); |
433 | sigprocmask (SIG_BLOCK, &sigs, NULL); |
377 | # endif |
434 | # endif |
378 | |
435 | |
379 | # if IOM_TIME |
436 | # if IOM_TIME |
|
|
437 | { |
|
|
438 | // update time, try to compensate for gross non-monotonic time changes |
|
|
439 | tstamp diff = NOW; |
380 | set_now (); |
440 | set_now (); |
|
|
441 | diff = NOW - diff; |
|
|
442 | |
|
|
443 | if (diff < 0) |
|
|
444 | for (io_manager_vec<time_watcher>::const_iterator i = tw.end (); i-- > tw.begin (); ) |
|
|
445 | if (*i) |
|
|
446 | (*i)->at += diff; |
|
|
447 | } |
381 | # endif |
448 | # endif |
382 | |
449 | |
383 | if (fds > 0) |
450 | if (fds > 0) |
384 | { |
451 | { |
385 | # if IOM_SIG |
452 | # if IOM_SIG |
… | |
… | |
388 | char ch; |
455 | char ch; |
389 | |
456 | |
390 | while (read (sigpipe[0], &ch, 1) > 0) |
457 | while (read (sigpipe[0], &ch, 1) > 0) |
391 | ; |
458 | ; |
392 | |
459 | |
393 | for (sig_vec **svp = sw.end (); svp-- > sw.begin (); ) |
460 | for (vector<sig_vec *>::iterator svp = sw.end (); svp-- > sw.begin (); ) |
394 | if (*svp && (*svp)->pending) |
461 | if (*svp && (*svp)->pending) |
395 | { |
462 | { |
396 | sig_vec &sv = **svp; |
463 | sig_vec &sv = **svp; |
397 | for (int i = sv.size (); i--; ) |
464 | for (int i = sv.size (); i--; ) |
398 | if (!sv[i]) |
465 | if (!sv[i]) |
… | |
… | |
409 | for (int i = iow.size (); i--; ) |
476 | for (int i = iow.size (); i--; ) |
410 | if (!iow[i]) |
477 | if (!iow[i]) |
411 | iow.erase_unordered (i); |
478 | iow.erase_unordered (i); |
412 | else |
479 | else |
413 | { |
480 | { |
|
|
481 | io_watcher &w = *iow[i]; |
414 | short revents = iow[i]->events; |
482 | short revents = w.events; |
415 | |
483 | |
416 | if (!FD_ISSET (iow[i]->fd, &rfd)) revents &= ~EVENT_READ; |
484 | if (!FD_ISSET (w.fd, &rfd)) revents &= ~EVENT_READ; |
417 | if (!FD_ISSET (iow[i]->fd, &wfd)) revents &= ~EVENT_WRITE; |
485 | if (!FD_ISSET (w.fd, &wfd)) revents &= ~EVENT_WRITE; |
418 | |
486 | |
419 | if (revents) |
487 | if (revents) |
420 | iow[i]->call (*iow[i], revents); |
488 | w.call (w, revents); |
421 | } |
489 | } |
422 | #endif |
490 | #endif |
423 | } |
491 | } |
424 | else if (fds < 0 && errno != EINTR) |
492 | else if (fds < 0 && errno != EINTR) |
425 | { |
493 | { |