#include #include #include #include #include #include #include #include #include "list.h" #include "poller.h" /* Used for signal handling */ struct poller *global_poller = NULL; void poller_init(struct poller *poller) { assert(global_poller == NULL); list_init(&poller->fds); list_init(&poller->new_fds); list_init(&poller->signals); list_init(&poller->new_signals); global_poller = poller; } int poller_finish(struct poller *poller) { for (size_t idx = 0; idx < poller->fds.length; idx++) { struct event_source_fd *bpfd = poller->fds.items[idx]; free(bpfd); } list_free(&poller->fds); for (size_t idx = 0; idx < poller->new_fds.length; idx++) { struct event_source_fd *bpfd = poller->new_fds.items[idx]; free(bpfd); } list_free(&poller->new_fds); for (size_t idx = 0; idx < poller->signals.length; idx++) { struct event_source_signal *bps = poller->signals.items[idx]; struct sigaction sa; sa.sa_handler = SIG_DFL; sigemptyset(&sa.sa_mask); sa.sa_flags = 0; sigaction(bps->signal, &sa, NULL); free(bps); } list_free(&poller->signals); for (size_t idx = 0; idx < poller->new_signals.length; idx++) { struct event_source_signal *bps = poller->new_signals.items[idx]; struct sigaction sa; sa.sa_handler = SIG_DFL; sigemptyset(&sa.sa_mask); sa.sa_flags = 0; sigaction(bps->signal, &sa, NULL); free(bps); } list_free(&poller->new_signals); free(poller->pollfds); return 0; } static int event_mask_to_poll_mask(uint32_t event_mask) { int poll_mask = 0; if (event_mask & EVENT_READABLE) { poll_mask |= POLLIN; } if (event_mask & EVENT_WRITABLE) { poll_mask |= POLLOUT; } return poll_mask; } static uint32_t poll_mask_to_event_mask(int poll_mask) { uint32_t event_mask = 0; if (poll_mask & POLLIN) { event_mask |= EVENT_READABLE; } if (poll_mask & POLLOUT) { event_mask |= EVENT_WRITABLE; } if (poll_mask & POLLERR) { event_mask |= EVENT_ERROR; } if (poll_mask & POLLHUP) { event_mask |= EVENT_HANGUP; } return event_mask; } static int regenerate_pollfds(struct poller *poller) { if (poller->pollfds_len != poller->fds.length) { struct pollfd *fds = calloc(poller->fds.length, sizeof(struct pollfd)); if (fds == NULL) { return -1; } free(poller->pollfds); poller->pollfds = fds; poller->pollfds_len = poller->fds.length; } for (size_t idx = 0; idx < poller->fds.length; idx++) { struct event_source_fd *bpfd = poller->fds.items[idx]; poller->pollfds[idx] = (struct pollfd){ .fd = bpfd->fd, .events = event_mask_to_poll_mask(bpfd->mask), }; } return 0; } struct event_source_fd *poller_add_fd(struct poller *poller, int fd, uint32_t mask, event_source_fd_func_t func, void *data) { struct event_source_fd *bpfd = calloc(1, sizeof(struct event_source_fd)); if (bpfd == NULL) { return NULL; } bpfd->fd = fd; bpfd->mask = mask; bpfd->data = data; bpfd->func = func; bpfd->poller = poller; poller->dirty = true; if (poller->inpoll) { list_add(&poller->new_fds, bpfd); } else { list_add(&poller->fds, bpfd); regenerate_pollfds(poller); } return (struct event_source_fd *)bpfd; } int event_source_fd_destroy(struct event_source_fd *event_source) { struct event_source_fd *bpfd = (struct event_source_fd *)event_source; struct poller *poller = bpfd->poller; int idx = list_find(&poller->fds, event_source); if (idx == -1) { return -1; } poller->dirty = true; if (poller->inpoll) { bpfd->killed = true; } else { list_del(&poller->fds, idx); free(bpfd); regenerate_pollfds(poller); } return 0; } int event_source_fd_update(struct event_source_fd *event_source, uint32_t mask) { struct event_source_fd *bpfd = (struct event_source_fd *)event_source; struct poller *poller = bpfd->poller; event_source->mask = mask; poller->dirty = true; if (!poller->inpoll) { regenerate_pollfds(poller); } return 0; } static void signal_handler(int sig) { if (global_poller == NULL) { return; } for (size_t idx = 0; idx < global_poller->signals.length; idx++) { struct event_source_signal *bps = global_poller->signals.items[idx]; if (bps->signal == sig) { bps->raised = true; } } } struct event_source_signal *poller_add_signal(struct poller *poller, int signal, event_source_signal_func_t func, void *data) { struct event_source_signal *bps = calloc(1, sizeof(struct event_source_signal)); if (bps == NULL) { return NULL; } int refcnt = 0; for (size_t idx = 0; idx < poller->signals.length; idx++) { struct event_source_signal *bps = poller->signals.items[idx]; if (bps->signal == signal) { refcnt++; } } bps->signal = signal; bps->data = data; bps->func = func; bps->poller = poller; if (refcnt == 0) { struct sigaction sa; sa.sa_handler = &signal_handler; sigemptyset(&sa.sa_mask); sa.sa_flags = 0; sigaction(signal, &sa, NULL); } if (poller->inpoll) { list_add(&poller->new_signals, bps); } else { list_add(&poller->signals, bps); } return (struct event_source_signal *)bps; } int event_source_signal_destroy(struct event_source_signal *event_source) { struct event_source_signal *bps = (struct event_source_signal *)event_source; struct poller *poller = bps->poller; int idx = list_find(&poller->signals, event_source); if (idx == -1) { return -1; } int refcnt = 0; for (size_t idx = 0; idx < poller->signals.length; idx++) { struct event_source_signal *b = poller->signals.items[idx]; if (b->signal == bps->signal) { refcnt++; } } if (refcnt == 0) { struct sigaction sa; sa.sa_handler = SIG_DFL; sigemptyset(&sa.sa_mask); sa.sa_flags = 0; sigaction(bps->signal, &sa, NULL); } if (poller->inpoll) { bps->killed = true; } else { list_del(&poller->signals, idx); free(bps); } return 0; } int poller_poll(struct poller *poller) { if (poll(poller->pollfds, poller->fds.length, -1) == -1 && errno != EINTR) { return -1; } poller->inpoll = true; for (size_t idx = 0; idx < poller->fds.length; idx++) { short revents = poller->pollfds[idx].revents; if (revents == 0) { continue; } struct event_source_fd *bpfd = poller->fds.items[idx]; bpfd->func(poller->pollfds[idx].fd, poll_mask_to_event_mask(revents), bpfd->data); } for (size_t idx = 0; idx < poller->signals.length; idx++) { struct event_source_signal *bps = poller->signals.items[idx]; if (!bps->raised) { continue; } bps->func(bps->signal, bps->data); bps->raised = false; } poller->inpoll = false; for (size_t idx = 0; idx < poller->fds.length; idx++) { struct event_source_fd *bpfd = poller->fds.items[idx]; if (!bpfd->killed) { continue; } list_del(&poller->fds, idx); free(bpfd); idx--; } for (size_t idx = 0; idx < poller->signals.length; idx++) { struct event_source_signal *bps = poller->signals.items[idx]; if (!bps->killed) { continue; } list_del(&poller->signals, idx); free(bps); idx--; } if (poller->new_fds.length > 0) { list_concat(&poller->fds, &poller->new_fds); list_truncate(&poller->new_fds); } if (poller->new_signals.length > 0) { list_concat(&poller->signals, &poller->new_signals); list_truncate(&poller->new_signals); } if (poller->dirty) { regenerate_pollfds(poller); poller->dirty = false; } return 0; }