123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344 |
- /*
- * Event loop based on select() loop
- * Copyright (c) 2002-2009, Jouni Malinen <j@w1.fi>
- *
- * This software may be distributed under the terms of the BSD license.
- * See README for more details.
- */
- #include "includes.h"
- #include <assert.h>
- #include "common.h"
- #include "trace.h"
- #include "list.h"
- #include "eloop.h"
- #if defined(CONFIG_ELOOP_POLL) && defined(CONFIG_ELOOP_EPOLL)
- #error Do not define both of poll and epoll
- #endif
- #if defined(CONFIG_ELOOP_POLL) && defined(CONFIG_ELOOP_KQUEUE)
- #error Do not define both of poll and kqueue
- #endif
- #if !defined(CONFIG_ELOOP_POLL) && !defined(CONFIG_ELOOP_EPOLL) && \
- !defined(CONFIG_ELOOP_KQUEUE)
- #define CONFIG_ELOOP_SELECT
- #endif
- #ifdef CONFIG_ELOOP_POLL
- #include <poll.h>
- #endif /* CONFIG_ELOOP_POLL */
- #ifdef CONFIG_ELOOP_EPOLL
- #include <sys/epoll.h>
- #endif /* CONFIG_ELOOP_EPOLL */
- #ifdef CONFIG_ELOOP_KQUEUE
- #include <sys/event.h>
- #endif /* CONFIG_ELOOP_KQUEUE */
- struct eloop_sock {
- int sock;
- void *eloop_data;
- void *user_data;
- eloop_sock_handler handler;
- WPA_TRACE_REF(eloop);
- WPA_TRACE_REF(user);
- WPA_TRACE_INFO
- };
- struct eloop_timeout {
- struct dl_list list;
- struct os_reltime time;
- void *eloop_data;
- void *user_data;
- eloop_timeout_handler handler;
- WPA_TRACE_REF(eloop);
- WPA_TRACE_REF(user);
- WPA_TRACE_INFO
- };
- struct eloop_signal {
- int sig;
- void *user_data;
- eloop_signal_handler handler;
- int signaled;
- };
- struct eloop_sock_table {
- int count;
- struct eloop_sock *table;
- eloop_event_type type;
- int changed;
- };
- struct eloop_data {
- int max_sock;
- int count; /* sum of all table counts */
- #ifdef CONFIG_ELOOP_POLL
- int max_pollfd_map; /* number of pollfds_map currently allocated */
- int max_poll_fds; /* number of pollfds currently allocated */
- struct pollfd *pollfds;
- struct pollfd **pollfds_map;
- #endif /* CONFIG_ELOOP_POLL */
- #if defined(CONFIG_ELOOP_EPOLL) || defined(CONFIG_ELOOP_KQUEUE)
- int max_fd;
- struct eloop_sock *fd_table;
- #endif /* CONFIG_ELOOP_EPOLL || CONFIG_ELOOP_KQUEUE */
- #ifdef CONFIG_ELOOP_EPOLL
- int epollfd;
- int epoll_max_event_num;
- struct epoll_event *epoll_events;
- #endif /* CONFIG_ELOOP_EPOLL */
- #ifdef CONFIG_ELOOP_KQUEUE
- int kqueuefd;
- int kqueue_nevents;
- struct kevent *kqueue_events;
- #endif /* CONFIG_ELOOP_KQUEUE */
- struct eloop_sock_table readers;
- struct eloop_sock_table writers;
- struct eloop_sock_table exceptions;
- struct dl_list timeout;
- int signal_count;
- struct eloop_signal *signals;
- int signaled;
- int pending_terminate;
- int terminate;
- };
- static struct eloop_data eloop;
- #ifdef WPA_TRACE
- static void eloop_sigsegv_handler(int sig)
- {
- wpa_trace_show("eloop SIGSEGV");
- abort();
- }
- static void eloop_trace_sock_add_ref(struct eloop_sock_table *table)
- {
- int i;
- if (table == NULL || table->table == NULL)
- return;
- for (i = 0; i < table->count; i++) {
- wpa_trace_add_ref(&table->table[i], eloop,
- table->table[i].eloop_data);
- wpa_trace_add_ref(&table->table[i], user,
- table->table[i].user_data);
- }
- }
- static void eloop_trace_sock_remove_ref(struct eloop_sock_table *table)
- {
- int i;
- if (table == NULL || table->table == NULL)
- return;
- for (i = 0; i < table->count; i++) {
- wpa_trace_remove_ref(&table->table[i], eloop,
- table->table[i].eloop_data);
- wpa_trace_remove_ref(&table->table[i], user,
- table->table[i].user_data);
- }
- }
- #else /* WPA_TRACE */
- #define eloop_trace_sock_add_ref(table) do { } while (0)
- #define eloop_trace_sock_remove_ref(table) do { } while (0)
- #endif /* WPA_TRACE */
- int eloop_init(void)
- {
- os_memset(&eloop, 0, sizeof(eloop));
- dl_list_init(&eloop.timeout);
- #ifdef CONFIG_ELOOP_EPOLL
- eloop.epollfd = epoll_create1(0);
- if (eloop.epollfd < 0) {
- wpa_printf(MSG_ERROR, "%s: epoll_create1 failed. %s",
- __func__, strerror(errno));
- return -1;
- }
- #endif /* CONFIG_ELOOP_EPOLL */
- #ifdef CONFIG_ELOOP_KQUEUE
- eloop.kqueuefd = kqueue();
- if (eloop.kqueuefd < 0) {
- wpa_printf(MSG_ERROR, "%s: kqueue failed: %s",
- __func__, strerror(errno));
- return -1;
- }
- #endif /* CONFIG_ELOOP_KQUEUE */
- #if defined(CONFIG_ELOOP_EPOLL) || defined(CONFIG_ELOOP_KQUEUE)
- eloop.readers.type = EVENT_TYPE_READ;
- eloop.writers.type = EVENT_TYPE_WRITE;
- eloop.exceptions.type = EVENT_TYPE_EXCEPTION;
- #endif /* CONFIG_ELOOP_EPOLL || CONFIG_ELOOP_KQUEUE */
- #ifdef WPA_TRACE
- signal(SIGSEGV, eloop_sigsegv_handler);
- #endif /* WPA_TRACE */
- return 0;
- }
- #ifdef CONFIG_ELOOP_EPOLL
- static int eloop_sock_queue(int sock, eloop_event_type type)
- {
- struct epoll_event ev;
- os_memset(&ev, 0, sizeof(ev));
- switch (type) {
- case EVENT_TYPE_READ:
- ev.events = EPOLLIN;
- break;
- case EVENT_TYPE_WRITE:
- ev.events = EPOLLOUT;
- break;
- /*
- * Exceptions are always checked when using epoll, but I suppose it's
- * possible that someone registered a socket *only* for exception
- * handling.
- */
- case EVENT_TYPE_EXCEPTION:
- ev.events = EPOLLERR | EPOLLHUP;
- break;
- }
- ev.data.fd = sock;
- if (epoll_ctl(eloop.epollfd, EPOLL_CTL_ADD, sock, &ev) < 0) {
- wpa_printf(MSG_ERROR, "%s: epoll_ctl(ADD) for fd=%d failed: %s",
- __func__, sock, strerror(errno));
- return -1;
- }
- return 0;
- }
- #endif /* CONFIG_ELOOP_EPOLL */
- #ifdef CONFIG_ELOOP_KQUEUE
- static int eloop_sock_queue(int sock, eloop_event_type type)
- {
- int filter;
- struct kevent ke;
- switch (type) {
- case EVENT_TYPE_READ:
- filter = EVFILT_READ;
- break;
- case EVENT_TYPE_WRITE:
- filter = EVFILT_WRITE;
- break;
- default:
- filter = 0;
- }
- EV_SET(&ke, sock, filter, EV_ADD, 0, 0, 0);
- if (kevent(eloop.kqueuefd, &ke, 1, NULL, 0, NULL) == -1) {
- wpa_printf(MSG_ERROR, "%s: kevent(ADD) for fd=%d failed: %s",
- __func__, sock, strerror(errno));
- return -1;
- }
- return 0;
- }
- #endif /* CONFIG_ELOOP_KQUEUE */
- static int eloop_sock_table_add_sock(struct eloop_sock_table *table,
- int sock, eloop_sock_handler handler,
- void *eloop_data, void *user_data)
- {
- #ifdef CONFIG_ELOOP_EPOLL
- struct epoll_event *temp_events;
- #endif /* CONFIG_ELOOP_EPOLL */
- #ifdef CONFIG_ELOOP_KQUEUE
- struct kevent *temp_events;
- #endif /* CONFIG_ELOOP_EPOLL */
- #if defined(CONFIG_ELOOP_EPOLL) || defined(CONFIG_ELOOP_KQUEUE)
- struct eloop_sock *temp_table;
- int next;
- #endif /* CONFIG_ELOOP_EPOLL || CONFIG_ELOOP_KQUEUE */
- struct eloop_sock *tmp;
- int new_max_sock;
- if (sock > eloop.max_sock)
- new_max_sock = sock;
- else
- new_max_sock = eloop.max_sock;
- if (table == NULL)
- return -1;
- #ifdef CONFIG_ELOOP_POLL
- if (new_max_sock >= eloop.max_pollfd_map) {
- struct pollfd **nmap;
- nmap = os_realloc_array(eloop.pollfds_map, new_max_sock + 50,
- sizeof(struct pollfd *));
- if (nmap == NULL)
- return -1;
- eloop.max_pollfd_map = new_max_sock + 50;
- eloop.pollfds_map = nmap;
- }
- if (eloop.count + 1 > eloop.max_poll_fds) {
- struct pollfd *n;
- int nmax = eloop.count + 1 + 50;
- n = os_realloc_array(eloop.pollfds, nmax,
- sizeof(struct pollfd));
- if (n == NULL)
- return -1;
- eloop.max_poll_fds = nmax;
- eloop.pollfds = n;
- }
- #endif /* CONFIG_ELOOP_POLL */
- #if defined(CONFIG_ELOOP_EPOLL) || defined(CONFIG_ELOOP_KQUEUE)
- if (new_max_sock >= eloop.max_fd) {
- next = eloop.max_fd == 0 ? 16 : eloop.max_fd * 2;
- temp_table = os_realloc_array(eloop.fd_table, next,
- sizeof(struct eloop_sock));
- if (temp_table == NULL)
- return -1;
- eloop.max_fd = next;
- eloop.fd_table = temp_table;
- }
- #endif /* CONFIG_ELOOP_EPOLL || CONFIG_ELOOP_KQUEUE */
- #ifdef CONFIG_ELOOP_EPOLL
- if (eloop.count + 1 > eloop.epoll_max_event_num) {
- next = eloop.epoll_max_event_num == 0 ? 8 :
- eloop.epoll_max_event_num * 2;
- temp_events = os_realloc_array(eloop.epoll_events, next,
- sizeof(struct epoll_event));
- if (temp_events == NULL) {
- wpa_printf(MSG_ERROR, "%s: malloc for epoll failed: %s",
- __func__, strerror(errno));
- return -1;
- }
- eloop.epoll_max_event_num = next;
- eloop.epoll_events = temp_events;
- }
- #endif /* CONFIG_ELOOP_EPOLL */
- #ifdef CONFIG_ELOOP_KQUEUE
- if (eloop.count + 1 > eloop.kqueue_nevents) {
- next = eloop.kqueue_nevents == 0 ? 8 : eloop.kqueue_nevents * 2;
- temp_events = os_malloc(next * sizeof(*temp_events));
- if (!temp_events) {
- wpa_printf(MSG_ERROR,
- "%s: malloc for kqueue failed: %s",
- __func__, strerror(errno));
- return -1;
- }
- os_free(eloop.kqueue_events);
- eloop.kqueue_events = temp_events;
- eloop.kqueue_nevents = next;
- }
- #endif /* CONFIG_ELOOP_KQUEUE */
- eloop_trace_sock_remove_ref(table);
- tmp = os_realloc_array(table->table, table->count + 1,
- sizeof(struct eloop_sock));
- if (tmp == NULL) {
- eloop_trace_sock_add_ref(table);
- return -1;
- }
- tmp[table->count].sock = sock;
- tmp[table->count].eloop_data = eloop_data;
- tmp[table->count].user_data = user_data;
- tmp[table->count].handler = handler;
- wpa_trace_record(&tmp[table->count]);
- table->count++;
- table->table = tmp;
- eloop.max_sock = new_max_sock;
- eloop.count++;
- table->changed = 1;
- eloop_trace_sock_add_ref(table);
- #if defined(CONFIG_ELOOP_EPOLL) || defined(CONFIG_ELOOP_KQUEUE)
- if (eloop_sock_queue(sock, table->type) < 0)
- return -1;
- os_memcpy(&eloop.fd_table[sock], &table->table[table->count - 1],
- sizeof(struct eloop_sock));
- #endif /* CONFIG_ELOOP_EPOLL || CONFIG_ELOOP_KQUEUE */
- return 0;
- }
- static void eloop_sock_table_remove_sock(struct eloop_sock_table *table,
- int sock)
- {
- #ifdef CONFIG_ELOOP_KQUEUE
- struct kevent ke;
- #endif /* CONFIG_ELOOP_KQUEUE */
- int i;
- if (table == NULL || table->table == NULL || table->count == 0)
- return;
- for (i = 0; i < table->count; i++) {
- if (table->table[i].sock == sock)
- break;
- }
- if (i == table->count)
- return;
- eloop_trace_sock_remove_ref(table);
- if (i != table->count - 1) {
- os_memmove(&table->table[i], &table->table[i + 1],
- (table->count - i - 1) *
- sizeof(struct eloop_sock));
- }
- table->count--;
- eloop.count--;
- table->changed = 1;
- eloop_trace_sock_add_ref(table);
- #ifdef CONFIG_ELOOP_EPOLL
- if (epoll_ctl(eloop.epollfd, EPOLL_CTL_DEL, sock, NULL) < 0) {
- wpa_printf(MSG_ERROR, "%s: epoll_ctl(DEL) for fd=%d failed: %s",
- __func__, sock, strerror(errno));
- return;
- }
- os_memset(&eloop.fd_table[sock], 0, sizeof(struct eloop_sock));
- #endif /* CONFIG_ELOOP_EPOLL */
- #ifdef CONFIG_ELOOP_KQUEUE
- EV_SET(&ke, sock, 0, EV_DELETE, 0, 0, 0);
- if (kevent(eloop.kqueuefd, &ke, 1, NULL, 0, NULL) < 0) {
- wpa_printf(MSG_ERROR, "%s: kevent(DEL) for fd=%d failed: %s",
- __func__, sock, strerror(errno));
- return;
- }
- os_memset(&eloop.fd_table[sock], 0, sizeof(struct eloop_sock));
- #endif /* CONFIG_ELOOP_KQUEUE */
- }
- #ifdef CONFIG_ELOOP_POLL
- static struct pollfd * find_pollfd(struct pollfd **pollfds_map, int fd, int mx)
- {
- if (fd < mx && fd >= 0)
- return pollfds_map[fd];
- return NULL;
- }
- static int eloop_sock_table_set_fds(struct eloop_sock_table *readers,
- struct eloop_sock_table *writers,
- struct eloop_sock_table *exceptions,
- struct pollfd *pollfds,
- struct pollfd **pollfds_map,
- int max_pollfd_map)
- {
- int i;
- int nxt = 0;
- int fd;
- struct pollfd *pfd;
- /* Clear pollfd lookup map. It will be re-populated below. */
- os_memset(pollfds_map, 0, sizeof(struct pollfd *) * max_pollfd_map);
- if (readers && readers->table) {
- for (i = 0; i < readers->count; i++) {
- fd = readers->table[i].sock;
- assert(fd >= 0 && fd < max_pollfd_map);
- pollfds[nxt].fd = fd;
- pollfds[nxt].events = POLLIN;
- pollfds[nxt].revents = 0;
- pollfds_map[fd] = &(pollfds[nxt]);
- nxt++;
- }
- }
- if (writers && writers->table) {
- for (i = 0; i < writers->count; i++) {
- /*
- * See if we already added this descriptor, update it
- * if so.
- */
- fd = writers->table[i].sock;
- assert(fd >= 0 && fd < max_pollfd_map);
- pfd = pollfds_map[fd];
- if (!pfd) {
- pfd = &(pollfds[nxt]);
- pfd->events = 0;
- pfd->fd = fd;
- pollfds[i].revents = 0;
- pollfds_map[fd] = pfd;
- nxt++;
- }
- pfd->events |= POLLOUT;
- }
- }
- /*
- * Exceptions are always checked when using poll, but I suppose it's
- * possible that someone registered a socket *only* for exception
- * handling. Set the POLLIN bit in this case.
- */
- if (exceptions && exceptions->table) {
- for (i = 0; i < exceptions->count; i++) {
- /*
- * See if we already added this descriptor, just use it
- * if so.
- */
- fd = exceptions->table[i].sock;
- assert(fd >= 0 && fd < max_pollfd_map);
- pfd = pollfds_map[fd];
- if (!pfd) {
- pfd = &(pollfds[nxt]);
- pfd->events = POLLIN;
- pfd->fd = fd;
- pollfds[i].revents = 0;
- pollfds_map[fd] = pfd;
- nxt++;
- }
- }
- }
- return nxt;
- }
- static int eloop_sock_table_dispatch_table(struct eloop_sock_table *table,
- struct pollfd **pollfds_map,
- int max_pollfd_map,
- short int revents)
- {
- int i;
- struct pollfd *pfd;
- if (!table || !table->table)
- return 0;
- table->changed = 0;
- for (i = 0; i < table->count; i++) {
- pfd = find_pollfd(pollfds_map, table->table[i].sock,
- max_pollfd_map);
- if (!pfd)
- continue;
- if (!(pfd->revents & revents))
- continue;
- table->table[i].handler(table->table[i].sock,
- table->table[i].eloop_data,
- table->table[i].user_data);
- if (table->changed)
- return 1;
- }
- return 0;
- }
- static void eloop_sock_table_dispatch(struct eloop_sock_table *readers,
- struct eloop_sock_table *writers,
- struct eloop_sock_table *exceptions,
- struct pollfd **pollfds_map,
- int max_pollfd_map)
- {
- if (eloop_sock_table_dispatch_table(readers, pollfds_map,
- max_pollfd_map, POLLIN | POLLERR |
- POLLHUP))
- return; /* pollfds may be invalid at this point */
- if (eloop_sock_table_dispatch_table(writers, pollfds_map,
- max_pollfd_map, POLLOUT))
- return; /* pollfds may be invalid at this point */
- eloop_sock_table_dispatch_table(exceptions, pollfds_map,
- max_pollfd_map, POLLERR | POLLHUP);
- }
- #endif /* CONFIG_ELOOP_POLL */
- #ifdef CONFIG_ELOOP_SELECT
- static void eloop_sock_table_set_fds(struct eloop_sock_table *table,
- fd_set *fds)
- {
- int i;
- FD_ZERO(fds);
- if (table->table == NULL)
- return;
- for (i = 0; i < table->count; i++) {
- assert(table->table[i].sock >= 0);
- FD_SET(table->table[i].sock, fds);
- }
- }
- static void eloop_sock_table_dispatch(struct eloop_sock_table *table,
- fd_set *fds)
- {
- int i;
- if (table == NULL || table->table == NULL)
- return;
- table->changed = 0;
- for (i = 0; i < table->count; i++) {
- if (FD_ISSET(table->table[i].sock, fds)) {
- table->table[i].handler(table->table[i].sock,
- table->table[i].eloop_data,
- table->table[i].user_data);
- if (table->changed)
- break;
- }
- }
- }
- #endif /* CONFIG_ELOOP_SELECT */
- #ifdef CONFIG_ELOOP_EPOLL
- static void eloop_sock_table_dispatch(struct epoll_event *events, int nfds)
- {
- struct eloop_sock *table;
- int i;
- for (i = 0; i < nfds; i++) {
- table = &eloop.fd_table[events[i].data.fd];
- if (table->handler == NULL)
- continue;
- table->handler(table->sock, table->eloop_data,
- table->user_data);
- if (eloop.readers.changed ||
- eloop.writers.changed ||
- eloop.exceptions.changed)
- break;
- }
- }
- #endif /* CONFIG_ELOOP_EPOLL */
- #ifdef CONFIG_ELOOP_KQUEUE
- static void eloop_sock_table_dispatch(struct kevent *events, int nfds)
- {
- struct eloop_sock *table;
- int i;
- for (i = 0; i < nfds; i++) {
- table = &eloop.fd_table[events[i].ident];
- if (table->handler == NULL)
- continue;
- table->handler(table->sock, table->eloop_data,
- table->user_data);
- if (eloop.readers.changed ||
- eloop.writers.changed ||
- eloop.exceptions.changed)
- break;
- }
- }
- static int eloop_sock_table_requeue(struct eloop_sock_table *table)
- {
- int i, r;
- r = 0;
- for (i = 0; i < table->count && table->table; i++) {
- if (eloop_sock_queue(table->table[i].sock, table->type) == -1)
- r = -1;
- }
- return r;
- }
- #endif /* CONFIG_ELOOP_KQUEUE */
- int eloop_sock_requeue(void)
- {
- int r = 0;
- #ifdef CONFIG_ELOOP_KQUEUE
- close(eloop.kqueuefd);
- eloop.kqueuefd = kqueue();
- if (eloop.kqueuefd < 0) {
- wpa_printf(MSG_ERROR, "%s: kqueue failed: %s",
- __func__, strerror(errno));
- return -1;
- }
- if (eloop_sock_table_requeue(&eloop.readers) < 0)
- r = -1;
- if (eloop_sock_table_requeue(&eloop.writers) < 0)
- r = -1;
- if (eloop_sock_table_requeue(&eloop.exceptions) < 0)
- r = -1;
- #endif /* CONFIG_ELOOP_KQUEUE */
- return r;
- }
- static void eloop_sock_table_destroy(struct eloop_sock_table *table)
- {
- if (table) {
- int i;
- for (i = 0; i < table->count && table->table; i++) {
- wpa_printf(MSG_INFO, "ELOOP: remaining socket: "
- "sock=%d eloop_data=%p user_data=%p "
- "handler=%p",
- table->table[i].sock,
- table->table[i].eloop_data,
- table->table[i].user_data,
- table->table[i].handler);
- wpa_trace_dump_funcname("eloop unregistered socket "
- "handler",
- table->table[i].handler);
- wpa_trace_dump("eloop sock", &table->table[i]);
- }
- os_free(table->table);
- }
- }
- int eloop_register_read_sock(int sock, eloop_sock_handler handler,
- void *eloop_data, void *user_data)
- {
- return eloop_register_sock(sock, EVENT_TYPE_READ, handler,
- eloop_data, user_data);
- }
- void eloop_unregister_read_sock(int sock)
- {
- eloop_unregister_sock(sock, EVENT_TYPE_READ);
- }
- static struct eloop_sock_table *eloop_get_sock_table(eloop_event_type type)
- {
- switch (type) {
- case EVENT_TYPE_READ:
- return &eloop.readers;
- case EVENT_TYPE_WRITE:
- return &eloop.writers;
- case EVENT_TYPE_EXCEPTION:
- return &eloop.exceptions;
- }
- return NULL;
- }
- int eloop_register_sock(int sock, eloop_event_type type,
- eloop_sock_handler handler,
- void *eloop_data, void *user_data)
- {
- struct eloop_sock_table *table;
- assert(sock >= 0);
- table = eloop_get_sock_table(type);
- return eloop_sock_table_add_sock(table, sock, handler,
- eloop_data, user_data);
- }
- void eloop_unregister_sock(int sock, eloop_event_type type)
- {
- struct eloop_sock_table *table;
- table = eloop_get_sock_table(type);
- eloop_sock_table_remove_sock(table, sock);
- }
- int eloop_register_timeout(unsigned int secs, unsigned int usecs,
- eloop_timeout_handler handler,
- void *eloop_data, void *user_data)
- {
- struct eloop_timeout *timeout, *tmp;
- os_time_t now_sec;
- timeout = os_zalloc(sizeof(*timeout));
- if (timeout == NULL)
- return -1;
- if (os_get_reltime(&timeout->time) < 0) {
- os_free(timeout);
- return -1;
- }
- now_sec = timeout->time.sec;
- timeout->time.sec += secs;
- if (timeout->time.sec < now_sec) {
- /*
- * Integer overflow - assume long enough timeout to be assumed
- * to be infinite, i.e., the timeout would never happen.
- */
- wpa_printf(MSG_DEBUG, "ELOOP: Too long timeout (secs=%u) to "
- "ever happen - ignore it", secs);
- os_free(timeout);
- return 0;
- }
- timeout->time.usec += usecs;
- while (timeout->time.usec >= 1000000) {
- timeout->time.sec++;
- timeout->time.usec -= 1000000;
- }
- timeout->eloop_data = eloop_data;
- timeout->user_data = user_data;
- timeout->handler = handler;
- wpa_trace_add_ref(timeout, eloop, eloop_data);
- wpa_trace_add_ref(timeout, user, user_data);
- wpa_trace_record(timeout);
- /* Maintain timeouts in order of increasing time */
- dl_list_for_each(tmp, &eloop.timeout, struct eloop_timeout, list) {
- if (os_reltime_before(&timeout->time, &tmp->time)) {
- dl_list_add(tmp->list.prev, &timeout->list);
- return 0;
- }
- }
- dl_list_add_tail(&eloop.timeout, &timeout->list);
- return 0;
- }
- static void eloop_remove_timeout(struct eloop_timeout *timeout)
- {
- dl_list_del(&timeout->list);
- wpa_trace_remove_ref(timeout, eloop, timeout->eloop_data);
- wpa_trace_remove_ref(timeout, user, timeout->user_data);
- os_free(timeout);
- }
- int eloop_cancel_timeout(eloop_timeout_handler handler,
- void *eloop_data, void *user_data)
- {
- struct eloop_timeout *timeout, *prev;
- int removed = 0;
- dl_list_for_each_safe(timeout, prev, &eloop.timeout,
- struct eloop_timeout, list) {
- if (timeout->handler == handler &&
- (timeout->eloop_data == eloop_data ||
- eloop_data == ELOOP_ALL_CTX) &&
- (timeout->user_data == user_data ||
- user_data == ELOOP_ALL_CTX)) {
- eloop_remove_timeout(timeout);
- removed++;
- }
- }
- return removed;
- }
- int eloop_cancel_timeout_one(eloop_timeout_handler handler,
- void *eloop_data, void *user_data,
- struct os_reltime *remaining)
- {
- struct eloop_timeout *timeout, *prev;
- int removed = 0;
- struct os_reltime now;
- os_get_reltime(&now);
- remaining->sec = remaining->usec = 0;
- dl_list_for_each_safe(timeout, prev, &eloop.timeout,
- struct eloop_timeout, list) {
- if (timeout->handler == handler &&
- (timeout->eloop_data == eloop_data) &&
- (timeout->user_data == user_data)) {
- removed = 1;
- if (os_reltime_before(&now, &timeout->time))
- os_reltime_sub(&timeout->time, &now, remaining);
- eloop_remove_timeout(timeout);
- break;
- }
- }
- return removed;
- }
- int eloop_is_timeout_registered(eloop_timeout_handler handler,
- void *eloop_data, void *user_data)
- {
- struct eloop_timeout *tmp;
- dl_list_for_each(tmp, &eloop.timeout, struct eloop_timeout, list) {
- if (tmp->handler == handler &&
- tmp->eloop_data == eloop_data &&
- tmp->user_data == user_data)
- return 1;
- }
- return 0;
- }
- int eloop_deplete_timeout(unsigned int req_secs, unsigned int req_usecs,
- eloop_timeout_handler handler, void *eloop_data,
- void *user_data)
- {
- struct os_reltime now, requested, remaining;
- struct eloop_timeout *tmp;
- dl_list_for_each(tmp, &eloop.timeout, struct eloop_timeout, list) {
- if (tmp->handler == handler &&
- tmp->eloop_data == eloop_data &&
- tmp->user_data == user_data) {
- requested.sec = req_secs;
- requested.usec = req_usecs;
- os_get_reltime(&now);
- os_reltime_sub(&tmp->time, &now, &remaining);
- if (os_reltime_before(&requested, &remaining)) {
- eloop_cancel_timeout(handler, eloop_data,
- user_data);
- eloop_register_timeout(requested.sec,
- requested.usec,
- handler, eloop_data,
- user_data);
- return 1;
- }
- return 0;
- }
- }
- return -1;
- }
- int eloop_replenish_timeout(unsigned int req_secs, unsigned int req_usecs,
- eloop_timeout_handler handler, void *eloop_data,
- void *user_data)
- {
- struct os_reltime now, requested, remaining;
- struct eloop_timeout *tmp;
- dl_list_for_each(tmp, &eloop.timeout, struct eloop_timeout, list) {
- if (tmp->handler == handler &&
- tmp->eloop_data == eloop_data &&
- tmp->user_data == user_data) {
- requested.sec = req_secs;
- requested.usec = req_usecs;
- os_get_reltime(&now);
- os_reltime_sub(&tmp->time, &now, &remaining);
- if (os_reltime_before(&remaining, &requested)) {
- eloop_cancel_timeout(handler, eloop_data,
- user_data);
- eloop_register_timeout(requested.sec,
- requested.usec,
- handler, eloop_data,
- user_data);
- return 1;
- }
- return 0;
- }
- }
- return -1;
- }
- #ifndef CONFIG_NATIVE_WINDOWS
- static void eloop_handle_alarm(int sig)
- {
- wpa_printf(MSG_ERROR, "eloop: could not process SIGINT or SIGTERM in "
- "two seconds. Looks like there\n"
- "is a bug that ends up in a busy loop that "
- "prevents clean shutdown.\n"
- "Killing program forcefully.\n");
- exit(1);
- }
- #endif /* CONFIG_NATIVE_WINDOWS */
- static void eloop_handle_signal(int sig)
- {
- int i;
- #ifndef CONFIG_NATIVE_WINDOWS
- if ((sig == SIGINT || sig == SIGTERM) && !eloop.pending_terminate) {
- /* Use SIGALRM to break out from potential busy loops that
- * would not allow the program to be killed. */
- eloop.pending_terminate = 1;
- signal(SIGALRM, eloop_handle_alarm);
- alarm(2);
- }
- #endif /* CONFIG_NATIVE_WINDOWS */
- eloop.signaled++;
- for (i = 0; i < eloop.signal_count; i++) {
- if (eloop.signals[i].sig == sig) {
- eloop.signals[i].signaled++;
- break;
- }
- }
- }
- static void eloop_process_pending_signals(void)
- {
- int i;
- if (eloop.signaled == 0)
- return;
- eloop.signaled = 0;
- if (eloop.pending_terminate) {
- #ifndef CONFIG_NATIVE_WINDOWS
- alarm(0);
- #endif /* CONFIG_NATIVE_WINDOWS */
- eloop.pending_terminate = 0;
- }
- for (i = 0; i < eloop.signal_count; i++) {
- if (eloop.signals[i].signaled) {
- eloop.signals[i].signaled = 0;
- eloop.signals[i].handler(eloop.signals[i].sig,
- eloop.signals[i].user_data);
- }
- }
- }
- int eloop_register_signal(int sig, eloop_signal_handler handler,
- void *user_data)
- {
- struct eloop_signal *tmp;
- tmp = os_realloc_array(eloop.signals, eloop.signal_count + 1,
- sizeof(struct eloop_signal));
- if (tmp == NULL)
- return -1;
- tmp[eloop.signal_count].sig = sig;
- tmp[eloop.signal_count].user_data = user_data;
- tmp[eloop.signal_count].handler = handler;
- tmp[eloop.signal_count].signaled = 0;
- eloop.signal_count++;
- eloop.signals = tmp;
- signal(sig, eloop_handle_signal);
- return 0;
- }
- int eloop_register_signal_terminate(eloop_signal_handler handler,
- void *user_data)
- {
- int ret = eloop_register_signal(SIGINT, handler, user_data);
- if (ret == 0)
- ret = eloop_register_signal(SIGTERM, handler, user_data);
- return ret;
- }
- int eloop_register_signal_reconfig(eloop_signal_handler handler,
- void *user_data)
- {
- #ifdef CONFIG_NATIVE_WINDOWS
- return 0;
- #else /* CONFIG_NATIVE_WINDOWS */
- return eloop_register_signal(SIGHUP, handler, user_data);
- #endif /* CONFIG_NATIVE_WINDOWS */
- }
- void eloop_run(void)
- {
- #ifdef CONFIG_ELOOP_POLL
- int num_poll_fds;
- int timeout_ms = 0;
- #endif /* CONFIG_ELOOP_POLL */
- #ifdef CONFIG_ELOOP_SELECT
- fd_set *rfds, *wfds, *efds;
- struct timeval _tv;
- #endif /* CONFIG_ELOOP_SELECT */
- #ifdef CONFIG_ELOOP_EPOLL
- int timeout_ms = -1;
- #endif /* CONFIG_ELOOP_EPOLL */
- #ifdef CONFIG_ELOOP_KQUEUE
- struct timespec ts;
- #endif /* CONFIG_ELOOP_KQUEUE */
- int res;
- struct os_reltime tv, now;
- #ifdef CONFIG_ELOOP_SELECT
- rfds = os_malloc(sizeof(*rfds));
- wfds = os_malloc(sizeof(*wfds));
- efds = os_malloc(sizeof(*efds));
- if (rfds == NULL || wfds == NULL || efds == NULL)
- goto out;
- #endif /* CONFIG_ELOOP_SELECT */
- while (!eloop.terminate &&
- (!dl_list_empty(&eloop.timeout) || eloop.readers.count > 0 ||
- eloop.writers.count > 0 || eloop.exceptions.count > 0)) {
- struct eloop_timeout *timeout;
- if (eloop.pending_terminate) {
- /*
- * This may happen in some corner cases where a signal
- * is received during a blocking operation. We need to
- * process the pending signals and exit if requested to
- * avoid hitting the SIGALRM limit if the blocking
- * operation took more than two seconds.
- */
- eloop_process_pending_signals();
- if (eloop.terminate)
- break;
- }
- timeout = dl_list_first(&eloop.timeout, struct eloop_timeout,
- list);
- if (timeout) {
- os_get_reltime(&now);
- if (os_reltime_before(&now, &timeout->time))
- os_reltime_sub(&timeout->time, &now, &tv);
- else
- tv.sec = tv.usec = 0;
- #if defined(CONFIG_ELOOP_POLL) || defined(CONFIG_ELOOP_EPOLL)
- timeout_ms = tv.sec * 1000 + tv.usec / 1000;
- #endif /* defined(CONFIG_ELOOP_POLL) || defined(CONFIG_ELOOP_EPOLL) */
- #ifdef CONFIG_ELOOP_SELECT
- _tv.tv_sec = tv.sec;
- _tv.tv_usec = tv.usec;
- #endif /* CONFIG_ELOOP_SELECT */
- #ifdef CONFIG_ELOOP_KQUEUE
- ts.tv_sec = tv.sec;
- ts.tv_nsec = tv.usec * 1000L;
- #endif /* CONFIG_ELOOP_KQUEUE */
- }
- #ifdef CONFIG_ELOOP_POLL
- num_poll_fds = eloop_sock_table_set_fds(
- &eloop.readers, &eloop.writers, &eloop.exceptions,
- eloop.pollfds, eloop.pollfds_map,
- eloop.max_pollfd_map);
- res = poll(eloop.pollfds, num_poll_fds,
- timeout ? timeout_ms : -1);
- #endif /* CONFIG_ELOOP_POLL */
- #ifdef CONFIG_ELOOP_SELECT
- eloop_sock_table_set_fds(&eloop.readers, rfds);
- eloop_sock_table_set_fds(&eloop.writers, wfds);
- eloop_sock_table_set_fds(&eloop.exceptions, efds);
- res = select(eloop.max_sock + 1, rfds, wfds, efds,
- timeout ? &_tv : NULL);
- #endif /* CONFIG_ELOOP_SELECT */
- #ifdef CONFIG_ELOOP_EPOLL
- if (eloop.count == 0) {
- res = 0;
- } else {
- res = epoll_wait(eloop.epollfd, eloop.epoll_events,
- eloop.count, timeout_ms);
- }
- #endif /* CONFIG_ELOOP_EPOLL */
- #ifdef CONFIG_ELOOP_KQUEUE
- if (eloop.count == 0) {
- res = 0;
- } else {
- res = kevent(eloop.kqueuefd, NULL, 0,
- eloop.kqueue_events, eloop.kqueue_nevents,
- timeout ? &ts : NULL);
- }
- #endif /* CONFIG_ELOOP_KQUEUE */
- if (res < 0 && errno != EINTR && errno != 0) {
- wpa_printf(MSG_ERROR, "eloop: %s: %s",
- #ifdef CONFIG_ELOOP_POLL
- "poll"
- #endif /* CONFIG_ELOOP_POLL */
- #ifdef CONFIG_ELOOP_SELECT
- "select"
- #endif /* CONFIG_ELOOP_SELECT */
- #ifdef CONFIG_ELOOP_EPOLL
- "epoll"
- #endif /* CONFIG_ELOOP_EPOLL */
- #ifdef CONFIG_ELOOP_KQUEUE
- "kqueue"
- #endif /* CONFIG_ELOOP_EKQUEUE */
- , strerror(errno));
- goto out;
- }
- eloop.readers.changed = 0;
- eloop.writers.changed = 0;
- eloop.exceptions.changed = 0;
- eloop_process_pending_signals();
- /* check if some registered timeouts have occurred */
- timeout = dl_list_first(&eloop.timeout, struct eloop_timeout,
- list);
- if (timeout) {
- os_get_reltime(&now);
- if (!os_reltime_before(&now, &timeout->time)) {
- void *eloop_data = timeout->eloop_data;
- void *user_data = timeout->user_data;
- eloop_timeout_handler handler =
- timeout->handler;
- eloop_remove_timeout(timeout);
- handler(eloop_data, user_data);
- }
- }
- if (res <= 0)
- continue;
- if (eloop.readers.changed ||
- eloop.writers.changed ||
- eloop.exceptions.changed) {
- /*
- * Sockets may have been closed and reopened with the
- * same FD in the signal or timeout handlers, so we
- * must skip the previous results and check again
- * whether any of the currently registered sockets have
- * events.
- */
- continue;
- }
- #ifdef CONFIG_ELOOP_POLL
- eloop_sock_table_dispatch(&eloop.readers, &eloop.writers,
- &eloop.exceptions, eloop.pollfds_map,
- eloop.max_pollfd_map);
- #endif /* CONFIG_ELOOP_POLL */
- #ifdef CONFIG_ELOOP_SELECT
- eloop_sock_table_dispatch(&eloop.readers, rfds);
- eloop_sock_table_dispatch(&eloop.writers, wfds);
- eloop_sock_table_dispatch(&eloop.exceptions, efds);
- #endif /* CONFIG_ELOOP_SELECT */
- #ifdef CONFIG_ELOOP_EPOLL
- eloop_sock_table_dispatch(eloop.epoll_events, res);
- #endif /* CONFIG_ELOOP_EPOLL */
- #ifdef CONFIG_ELOOP_KQUEUE
- eloop_sock_table_dispatch(eloop.kqueue_events, res);
- #endif /* CONFIG_ELOOP_KQUEUE */
- }
- eloop.terminate = 0;
- out:
- #ifdef CONFIG_ELOOP_SELECT
- os_free(rfds);
- os_free(wfds);
- os_free(efds);
- #endif /* CONFIG_ELOOP_SELECT */
- return;
- }
- void eloop_terminate(void)
- {
- eloop.terminate = 1;
- }
- void eloop_destroy(void)
- {
- struct eloop_timeout *timeout, *prev;
- struct os_reltime now;
- os_get_reltime(&now);
- dl_list_for_each_safe(timeout, prev, &eloop.timeout,
- struct eloop_timeout, list) {
- int sec, usec;
- sec = timeout->time.sec - now.sec;
- usec = timeout->time.usec - now.usec;
- if (timeout->time.usec < now.usec) {
- sec--;
- usec += 1000000;
- }
- wpa_printf(MSG_INFO, "ELOOP: remaining timeout: %d.%06d "
- "eloop_data=%p user_data=%p handler=%p",
- sec, usec, timeout->eloop_data, timeout->user_data,
- timeout->handler);
- wpa_trace_dump_funcname("eloop unregistered timeout handler",
- timeout->handler);
- wpa_trace_dump("eloop timeout", timeout);
- eloop_remove_timeout(timeout);
- }
- eloop_sock_table_destroy(&eloop.readers);
- eloop_sock_table_destroy(&eloop.writers);
- eloop_sock_table_destroy(&eloop.exceptions);
- os_free(eloop.signals);
- #ifdef CONFIG_ELOOP_POLL
- os_free(eloop.pollfds);
- os_free(eloop.pollfds_map);
- #endif /* CONFIG_ELOOP_POLL */
- #if defined(CONFIG_ELOOP_EPOLL) || defined(CONFIG_ELOOP_KQUEUE)
- os_free(eloop.fd_table);
- #endif /* CONFIG_ELOOP_EPOLL || CONFIG_ELOOP_KQUEUE */
- #ifdef CONFIG_ELOOP_EPOLL
- os_free(eloop.epoll_events);
- close(eloop.epollfd);
- #endif /* CONFIG_ELOOP_EPOLL */
- #ifdef CONFIG_ELOOP_KQUEUE
- os_free(eloop.kqueue_events);
- close(eloop.kqueuefd);
- #endif /* CONFIG_ELOOP_KQUEUE */
- }
- int eloop_terminated(void)
- {
- return eloop.terminate || eloop.pending_terminate;
- }
- void eloop_wait_for_read_sock(int sock)
- {
- #ifdef CONFIG_ELOOP_POLL
- struct pollfd pfd;
- if (sock < 0)
- return;
- os_memset(&pfd, 0, sizeof(pfd));
- pfd.fd = sock;
- pfd.events = POLLIN;
- poll(&pfd, 1, -1);
- #endif /* CONFIG_ELOOP_POLL */
- #if defined(CONFIG_ELOOP_SELECT) || defined(CONFIG_ELOOP_EPOLL)
- /*
- * We can use epoll() here. But epoll() requres 4 system calls.
- * epoll_create1(), epoll_ctl() for ADD, epoll_wait, and close() for
- * epoll fd. So select() is better for performance here.
- */
- fd_set rfds;
- if (sock < 0)
- return;
- FD_ZERO(&rfds);
- FD_SET(sock, &rfds);
- select(sock + 1, &rfds, NULL, NULL, NULL);
- #endif /* defined(CONFIG_ELOOP_SELECT) || defined(CONFIG_ELOOP_EPOLL) */
- #ifdef CONFIG_ELOOP_KQUEUE
- int kfd;
- struct kevent ke1, ke2;
- kfd = kqueue();
- if (kfd == -1)
- return;
- EV_SET(&ke1, sock, EVFILT_READ, EV_ADD | EV_ONESHOT, 0, 0, 0);
- kevent(kfd, &ke1, 1, &ke2, 1, NULL);
- close(kfd);
- #endif /* CONFIG_ELOOP_KQUEUE */
- }
- #ifdef CONFIG_ELOOP_SELECT
- #undef CONFIG_ELOOP_SELECT
- #endif /* CONFIG_ELOOP_SELECT */
|