2 * UCW Library -- Main Loop
4 * (c) 2004--2010 Martin Mares <mj@ucw.cz>
6 * This software may be freely distributed and used according to the terms
7 * of the GNU Lesser General Public License.
14 #include "ucw/mainloop.h"
15 #include "ucw/threads.h"
30 #define MAIN_TIMER_LESS(x,y) ((x)->expires < (y)->expires)
31 #define MAIN_TIMER_SWAP(heap,a,b,t) (t=heap[a], heap[a]=heap[b], heap[b]=t, heap[a]->index=(a), heap[b]->index=(b))
33 // FIXME: Delivery of signals to threads?
34 static uns main_sigchld_set_up;
35 static volatile sig_atomic_t chld_received = 0;
38 // On recent Linux systems, O_CLOEXEC flag is available and we can get around
39 // the race condition of poll().
41 static int sig_pipe_recv, sig_pipe_send;
45 do_main_get_time(struct main_context *m)
48 gettimeofday(&tv, NULL);
49 m->now_seconds = tv.tv_sec;
50 m->now = (timestamp_t)tv.tv_sec * 1000 + tv.tv_usec / 1000;
56 struct main_context *m = xmalloc_zero(sizeof(*m));
58 DBG("MAIN: New context");
59 clist_init(&m->file_list);
60 clist_init(&m->hook_list);
61 clist_init(&m->hook_done_list);
62 clist_init(&m->process_list);
63 m->poll_table_obsolete = 1;
70 main_delete(struct main_context *m)
72 ASSERT(clist_empty(&m->file_list));
73 ASSERT(clist_empty(&m->hook_list));
74 ASSERT(clist_empty(&m->hook_done_list));
75 ASSERT(clist_empty(&m->process_list));
77 GARY_FREE(m->timer_table);
80 // FIXME: Some mechanism for cleaning up after fork()
84 main_switch_context(struct main_context *m)
86 struct ucwlib_context *c = ucwlib_thread_context();
87 struct main_context *m0 = c->main_context;
95 struct ucwlib_context *c = ucwlib_thread_context();
96 struct main_context *m = c->main_context;
104 struct main_context *m = main_switch_context(main_new());
111 struct main_context *m = main_switch_context(NULL);
118 do_main_get_time(main_current());
122 count_timers(struct main_context *m)
124 return GARY_SIZE(m->timer_table) - 1;
128 timer_add(struct main_timer *tm, timestamp_t expires)
130 struct main_context *m = main_current();
134 GARY_INIT(m->timer_table, 1);
135 m->timer_table[0] = NULL;
139 DBG("MAIN: Setting timer %p (expire at now+%lld)", tm, (long long)(expires - m->now));
141 DBG("MAIN: Clearing timer %p", tm);
142 uns num_timers = count_timers(m);
143 if (tm->expires < expires)
147 tm->expires = expires;
148 tm->index = num_timers + 1;
149 *GARY_PUSH(m->timer_table, 1) = tm;
150 HEAP_INSERT(struct main_timer *, m->timer_table, tm->index, MAIN_TIMER_LESS, MAIN_TIMER_SWAP);
154 tm->expires = expires;
155 HEAP_INCREASE(struct main_timer *, m->timer_table, num_timers, MAIN_TIMER_LESS, MAIN_TIMER_SWAP, tm->index);
158 else if (tm->expires > expires)
162 ASSERT(tm->index && tm->index <= num_timers);
163 HEAP_DELETE(struct main_timer *, m->timer_table, num_timers, MAIN_TIMER_LESS, MAIN_TIMER_SWAP, tm->index);
166 GARY_POP(m->timer_table, 1);
170 tm->expires = expires;
171 HEAP_DECREASE(struct main_timer *, m->timer_table, num_timers, MAIN_TIMER_LESS, MAIN_TIMER_SWAP, tm->index);
177 timer_add_rel(struct main_timer *tm, timestamp_t expires_delta)
179 struct main_context *m = main_current();
180 return timer_add(tm, m->now + expires_delta);
184 timer_del(struct main_timer *tm)
190 file_timer_expired(struct main_timer *tm)
192 struct main_file *fi = tm->data;
193 timer_del(&fi->timer);
194 if (fi->error_handler)
195 fi->error_handler(fi, MFERR_TIMEOUT);
199 file_add(struct main_file *fi)
201 struct main_context *m = main_current();
203 DBG("MAIN: Adding file %p (fd=%d)", fi, fi->fd);
205 clist_add_tail(&m->file_list, &fi->n);
206 fi->timer.handler = file_timer_expired;
209 m->poll_table_obsolete = 1;
210 if (fcntl(fi->fd, F_SETFL, O_NONBLOCK) < 0)
211 msg(L_ERROR, "Error setting fd %d to non-blocking mode: %m. Keep fingers crossed.", fi->fd);
215 file_chg(struct main_file *fi)
217 struct pollfd *p = fi->pollfd;
221 if (fi->read_handler)
222 p->events |= POLLIN | POLLHUP | POLLERR;
223 if (fi->write_handler)
224 p->events |= POLLOUT | POLLERR;
229 file_del(struct main_file *fi)
231 struct main_context *m = main_current();
233 DBG("MAIN: Deleting file %p (fd=%d)", fi, fi->fd);
235 timer_del(&fi->timer);
236 clist_remove(&fi->n);
238 m->poll_table_obsolete = 1;
239 fi->n.next = fi->n.prev = NULL;
243 file_read_handler(struct main_file *fi)
245 while (fi->rpos < fi->rlen)
247 int l = read(fi->fd, fi->rbuf + fi->rpos, fi->rlen - fi->rpos);
248 DBG("MAIN: FD %d: read %d", fi->fd, l);
251 if (errno != EINTR && errno != EAGAIN && fi->error_handler)
252 fi->error_handler(fi, MFERR_READ);
259 DBG("MAIN: FD %d done read %d of %d", fi->fd, fi->rpos, fi->rlen);
260 fi->read_handler = NULL;
267 file_write_handler(struct main_file *fi)
269 while (fi->wpos < fi->wlen)
271 int l = write(fi->fd, fi->wbuf + fi->wpos, fi->wlen - fi->wpos);
272 DBG("MAIN: FD %d: write %d", fi->fd, l);
275 if (errno != EINTR && errno != EAGAIN && fi->error_handler)
276 fi->error_handler(fi, MFERR_WRITE);
281 DBG("MAIN: FD %d done write %d", fi->fd, fi->wpos);
282 fi->write_handler = NULL;
289 file_read(struct main_file *fi, void *buf, uns len)
294 fi->read_handler = file_read_handler;
301 fi->read_handler = NULL;
303 fi->rpos = fi->rlen = 0;
309 file_write(struct main_file *fi, void *buf, uns len)
314 fi->write_handler = file_write_handler;
321 fi->write_handler = NULL;
323 fi->wpos = fi->wlen = 0;
329 file_set_timeout(struct main_file *fi, timestamp_t expires)
332 timer_add(&fi->timer, expires);
338 struct main_context *m = main_current();
340 CLIST_FOR_EACH(struct main_file *, f, m->file_list)
345 hook_add(struct main_hook *ho)
347 struct main_context *m = main_current();
349 DBG("MAIN: Adding hook %p", ho);
351 clist_add_tail(&m->hook_list, &ho->n);
355 hook_del(struct main_hook *ho)
357 DBG("MAIN: Deleting hook %p", ho);
359 clist_remove(&ho->n);
360 ho->n.next = ho->n.prev = NULL;
365 main_sigchld_handler(int x UNUSED)
367 int old_errno = errno;
368 DBG("SIGCHLD received");
371 while((result = write(sig_pipe_send, "c", 1)) == -1 && errno == EINTR);
372 if(result == -1 && errno != EAGAIN)
373 msg(L_SIGHANDLER|L_ERROR, "Could not write to self-pipe: %m");
378 dummy_read_handler(struct main_file *mp)
381 ssize_t result = read(mp->fd, buffer, 1024);
382 if(result == -1 && errno != EAGAIN)
383 msg(L_ERROR, "Could not read from selfpipe: %m");
385 return result == 1024;
389 pipe_configure(int fd)
392 if((flags = fcntl(fd, F_GETFL)) == -1 || fcntl(fd, F_SETFL, flags|O_NONBLOCK))
393 die("Could not set file descriptor %d to non-blocking: %m", fd);
394 if((flags = fcntl(fd, F_GETFD)) == -1 || fcntl(fd, F_SETFD, flags|O_CLOEXEC))
395 die("Could not set file descriptor %d to close-on-exec: %m", fd);
399 main_sigchld_handler(int x UNUSED)
401 DBG("SIGCHLD received");
406 process_add(struct main_process *mp)
408 struct main_context *m = main_current();
410 DBG("MAIN: Adding process %p (pid=%d)", mp, mp->pid);
413 clist_add_tail(&m->process_list, &mp->n);
414 if (!main_sigchld_set_up)
418 if(pipe(pipe_result) == -1)
419 die("Could not create selfpipe:%m");
420 pipe_configure(pipe_result[0]);
421 pipe_configure(pipe_result[1]);
422 sig_pipe_recv = pipe_result[0];
423 sig_pipe_send = pipe_result[1];
424 static struct main_file self_pipe;
425 self_pipe = (struct main_file) {
427 .read_handler = dummy_read_handler
429 file_add(&self_pipe);
432 bzero(&sa, sizeof(sa));
433 sa.sa_handler = main_sigchld_handler;
434 sa.sa_flags = SA_NOCLDSTOP | SA_RESTART;
435 sigaction(SIGCHLD, &sa, NULL);
436 main_sigchld_set_up = 1;
437 chld_received = 1; // The signal may have come before the handler
442 process_del(struct main_process *mp)
444 DBG("MAIN: Deleting process %p (pid=%d)", mp, mp->pid);
446 clist_remove(&mp->n);
451 process_fork(struct main_process *mp)
456 DBG("MAIN: Fork failed");
458 format_exit_status(mp->status_msg, -1);
466 DBG("MAIN: Forked process %d", (int) pid);
474 main_debug_context(struct main_context *m UNUSED)
477 msg(L_DEBUG, "### Main loop status on %lld", (long long) m->now);
478 msg(L_DEBUG, "\tActive timers:");
479 uns num_timers = count_timers(m);
480 for (uns i = 1; i <= num_timers; i++)
482 struct main_timer *tm = m->timer_table[i];
483 msg(L_DEBUG, "\t\t%p (expires %lld, data %p)", tm, (long long)(tm->expires ? tm->expires - m->now : 999999), tm->data);
485 struct main_file *fi;
486 msg(L_DEBUG, "\tActive files:");
487 CLIST_WALK(fi, m->file_list)
488 msg(L_DEBUG, "\t\t%p (fd %d, rh %p, wh %p, eh %p, expires %lld, data %p)",
489 fi, fi->fd, fi->read_handler, fi->write_handler, fi->error_handler,
490 (long long)(fi->timer.expires ? fi->timer.expires - m->now : 999999), fi->data);
491 msg(L_DEBUG, "\tActive hooks:");
492 struct main_hook *ho;
493 CLIST_WALK(ho, m->hook_done_list)
494 msg(L_DEBUG, "\t\t%p (func %p, data %p)", ho, ho->handler, ho->data);
495 CLIST_WALK(ho, m->hook_list)
496 msg(L_DEBUG, "\t\t%p (func %p, data %p)", ho, ho->handler, ho->data);
497 msg(L_DEBUG, "\tActive processes:");
498 struct main_process *pr;
499 CLIST_WALK(pr, m->process_list)
500 msg(L_DEBUG, "\t\t%p (pid %d, data %p)", pr, pr->pid, pr->data);
505 main_rebuild_poll_table(struct main_context *m)
507 struct main_file *fi;
508 if (m->poll_table_size < m->file_cnt)
511 xfree(m->poll_table);
513 m->poll_table_size = 1;
514 while (m->poll_table_size < m->file_cnt)
515 m->poll_table_size *= 2;
516 m->poll_table = xmalloc(sizeof(struct pollfd) * m->poll_table_size);
518 struct pollfd *p = m->poll_table;
519 DBG("MAIN: Rebuilding poll table: %d of %d entries set", m->file_cnt, m->poll_table_size);
520 CLIST_WALK(fi, m->file_list)
526 m->poll_table_obsolete = 0;
532 DBG("MAIN: Entering main_loop");
533 struct main_context *m = main_current();
535 struct main_file *fi;
536 struct main_hook *ho;
537 struct main_timer *tm;
538 struct main_process *pr;
543 timestamp_t wake = m->now + 1000000000;
544 while (GARY_SIZE(m->timer_table) > 1 && (tm = m->timer_table[1])->expires <= m->now)
546 DBG("MAIN: Timer %p expired at now-%lld", tm, (long long)(m->now - tm->expires));
549 int hook_min = HOOK_RETRY;
550 int hook_max = HOOK_SHUTDOWN;
551 while (ho = clist_remove_head(&m->hook_list))
553 clist_add_tail(&m->hook_done_list, &ho->n);
554 DBG("MAIN: Hook %p", ho);
555 int ret = ho->handler(ho);
556 hook_min = MIN(hook_min, ret);
557 hook_max = MAX(hook_max, ret);
559 clist_move(&m->hook_list, &m->hook_done_list);
560 if (hook_min == HOOK_SHUTDOWN ||
561 hook_min == HOOK_DONE && hook_max == HOOK_DONE ||
564 DBG("MAIN: Shut down by %s", m->shutdown ? "main_shutdown" : "a hook");
567 if (hook_max == HOOK_RETRY)
569 if (m->poll_table_obsolete)
570 main_rebuild_poll_table(m);
571 #ifndef USE_SELF_PIPE
572 // We don't have a reliable flag without the self-pipe.
575 if (chld_received && !clist_empty(&m->process_list))
579 wake = MIN(wake, m->now + 10000);
581 while ((pid = waitpid(-1, &stat, WNOHANG)) > 0)
583 DBG("MAIN: Child %d exited with status %x", pid, stat);
584 CLIST_WALK(pr, m->process_list)
589 format_exit_status(pr->status_msg, pr->status);
590 DBG("MAIN: Calling process exit handler");
597 if (count_timers(m) && (tm = m->timer_table[1])->expires < wake)
600 int timeout = ((wake > m->now) ? wake - m->now : 0);
601 DBG("MAIN: Poll for %d fds and timeout %d ms", m->file_cnt, timeout);
602 int p = poll(m->poll_table, m->file_cnt, timeout);
603 timestamp_t old_now = m->now;
605 m->idle_time += m->now - old_now;
608 struct pollfd *p = m->poll_table;
609 CLIST_WALK(fi, m->file_list)
611 if (p->revents & (POLLIN | POLLHUP | POLLERR))
614 DBG("MAIN: Read event on fd %d", p->fd);
615 while (fi->read_handler && fi->read_handler(fi) && !m->poll_table_obsolete);
616 if (m->poll_table_obsolete) /* File entries have been inserted or deleted => better not risk continuing to nowhere */
619 if (p->revents & (POLLOUT | POLLERR))
622 DBG("MAIN: Write event on fd %d", p->fd);
623 while (fi->write_handler && fi->write_handler(fi) && !m->poll_table_obsolete);
624 if (m->poll_table_obsolete)
635 static struct main_process mp;
636 static struct main_file fin, fout;
637 static struct main_hook hook;
638 static struct main_timer tm;
642 static void dread(struct main_file *fi)
644 if (fi->rpos < fi->rlen)
646 msg(L_INFO, "Read EOF");
651 msg(L_INFO, "Read done");
652 file_read(fi, rb, sizeof(rb));
656 static void derror(struct main_file *fi, int cause)
658 msg(L_INFO, "Error: %m !!! (cause %d)", cause);
662 static void dwrite(struct main_file *fi UNUSED)
664 msg(L_INFO, "Write done");
667 static int dhook(struct main_hook *ho UNUSED)
669 msg(L_INFO, "Hook called");
673 static void dtimer(struct main_timer *tm)
675 msg(L_INFO, "Timer tick");
676 timer_add_rel(tm, 11000);
677 timer_add_rel(tm, 10000);
680 static void dentry(void)
682 msg(L_INFO, "*** SUBPROCESS START ***");
684 msg(L_INFO, "*** SUBPROCESS FINISH ***");
688 static void dexit(struct main_process *pr)
690 msg(L_INFO, "Subprocess %d exited with status %x", pr->pid, pr->status);
700 fin.read_done = dread;
701 fin.error_handler = derror;
703 file_read(&fin, rb, sizeof(rb));
706 fout.write_done = dwrite;
707 fout.error_handler = derror;
709 file_write(&fout, "Hello, world!\n", 14);
711 hook.handler = dhook;
715 timer_add_rel(&tm, 1000);
718 if (!process_fork(&mp))
724 msg(L_INFO, "Finished.");