2 * Event loop based on select() loop
3 * Copyright (c) 2002-2009, Jouni Malinen <j@w1.fi>
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
16 #ifdef CONFIG_ELOOP_POLL
19 #endif /* CONFIG_ELOOP_POLL */
26 eloop_sock_handler handler;
32 struct eloop_timeout {
37 eloop_timeout_handler handler;
46 eloop_signal_handler handler;
50 struct eloop_sock_table {
52 struct eloop_sock *table;
59 int count; /* sum of all table counts */
60 #ifdef CONFIG_ELOOP_POLL
61 int max_pollfd_map; /* number of pollfds_map currently allocated */
62 int max_poll_fds; /* number of pollfds currently allocated */
63 struct pollfd *pollfds;
64 struct pollfd **pollfds_map;
65 #endif /* CONFIG_ELOOP_POLL */
66 struct eloop_sock_table readers;
67 struct eloop_sock_table writers;
68 struct eloop_sock_table exceptions;
70 struct dl_list timeout;
73 struct eloop_signal *signals;
75 int pending_terminate;
78 int reader_table_changed;
81 static struct eloop_data eloop;
86 static void eloop_sigsegv_handler(int sig)
88 wpa_trace_show("eloop SIGSEGV");
92 static void eloop_trace_sock_add_ref(struct eloop_sock_table *table)
95 if (table == NULL || table->table == NULL)
97 for (i = 0; i < table->count; i++) {
98 wpa_trace_add_ref(&table->table[i], eloop,
99 table->table[i].eloop_data);
100 wpa_trace_add_ref(&table->table[i], user,
101 table->table[i].user_data);
106 static void eloop_trace_sock_remove_ref(struct eloop_sock_table *table)
109 if (table == NULL || table->table == NULL)
111 for (i = 0; i < table->count; i++) {
112 wpa_trace_remove_ref(&table->table[i], eloop,
113 table->table[i].eloop_data);
114 wpa_trace_remove_ref(&table->table[i], user,
115 table->table[i].user_data);
119 #else /* WPA_TRACE */
121 #define eloop_trace_sock_add_ref(table) do { } while (0)
122 #define eloop_trace_sock_remove_ref(table) do { } while (0)
124 #endif /* WPA_TRACE */
129 os_memset(&eloop, 0, sizeof(eloop));
130 dl_list_init(&eloop.timeout);
132 signal(SIGSEGV, eloop_sigsegv_handler);
133 #endif /* WPA_TRACE */
138 static int eloop_sock_table_add_sock(struct eloop_sock_table *table,
139 int sock, eloop_sock_handler handler,
140 void *eloop_data, void *user_data)
142 struct eloop_sock *tmp;
145 if (sock > eloop.max_sock)
148 new_max_sock = eloop.max_sock;
153 #ifdef CONFIG_ELOOP_POLL
154 if (new_max_sock >= eloop.max_pollfd_map) {
155 struct pollfd **nmap;
156 nmap = os_realloc_array(eloop.pollfds_map, new_max_sock + 50,
157 sizeof(struct pollfd *));
161 eloop.max_pollfd_map = new_max_sock + 50;
162 eloop.pollfds_map = nmap;
165 if (eloop.count + 1 > eloop.max_poll_fds) {
167 int nmax = eloop.count + 1 + 50;
168 n = os_realloc_array(eloop.pollfds, nmax,
169 sizeof(struct pollfd));
173 eloop.max_poll_fds = nmax;
176 #endif /* CONFIG_ELOOP_POLL */
178 eloop_trace_sock_remove_ref(table);
179 tmp = os_realloc_array(table->table, table->count + 1,
180 sizeof(struct eloop_sock));
184 tmp[table->count].sock = sock;
185 tmp[table->count].eloop_data = eloop_data;
186 tmp[table->count].user_data = user_data;
187 tmp[table->count].handler = handler;
188 wpa_trace_record(&tmp[table->count]);
191 eloop.max_sock = new_max_sock;
194 eloop_trace_sock_add_ref(table);
200 static void eloop_sock_table_remove_sock(struct eloop_sock_table *table,
205 if (table == NULL || table->table == NULL || table->count == 0)
208 for (i = 0; i < table->count; i++) {
209 if (table->table[i].sock == sock)
212 if (i == table->count)
214 eloop_trace_sock_remove_ref(table);
215 if (i != table->count - 1) {
216 os_memmove(&table->table[i], &table->table[i + 1],
217 (table->count - i - 1) *
218 sizeof(struct eloop_sock));
223 eloop_trace_sock_add_ref(table);
227 #ifdef CONFIG_ELOOP_POLL
229 static struct pollfd * find_pollfd(struct pollfd **pollfds_map, int fd, int mx)
231 if (fd < mx && fd >= 0)
232 return pollfds_map[fd];
237 static int eloop_sock_table_set_fds(struct eloop_sock_table *readers,
238 struct eloop_sock_table *writers,
239 struct eloop_sock_table *exceptions,
240 struct pollfd *pollfds,
241 struct pollfd **pollfds_map,
249 /* Clear pollfd lookup map. It will be re-populated below. */
250 os_memset(pollfds_map, 0, sizeof(struct pollfd *) * max_pollfd_map);
252 if (readers && readers->table) {
253 for (i = 0; i < readers->count; i++) {
254 fd = readers->table[i].sock;
255 assert(fd >= 0 && fd < max_pollfd_map);
256 pollfds[nxt].fd = fd;
257 pollfds[nxt].events = POLLIN;
258 pollfds[nxt].revents = 0;
259 pollfds_map[fd] = &(pollfds[nxt]);
264 if (writers && writers->table) {
265 for (i = 0; i < writers->count; i++) {
267 * See if we already added this descriptor, update it
270 fd = writers->table[i].sock;
271 assert(fd >= 0 && fd < max_pollfd_map);
272 pfd = pollfds_map[fd];
274 pfd = &(pollfds[nxt]);
277 pollfds[i].revents = 0;
278 pollfds_map[fd] = pfd;
281 pfd->events |= POLLOUT;
286 * Exceptions are always checked when using poll, but I suppose it's
287 * possible that someone registered a socket *only* for exception
288 * handling. Set the POLLIN bit in this case.
290 if (exceptions && exceptions->table) {
291 for (i = 0; i < exceptions->count; i++) {
293 * See if we already added this descriptor, just use it
296 fd = exceptions->table[i].sock;
297 assert(fd >= 0 && fd < max_pollfd_map);
298 pfd = pollfds_map[fd];
300 pfd = &(pollfds[nxt]);
301 pfd->events = POLLIN;
303 pollfds[i].revents = 0;
304 pollfds_map[fd] = pfd;
314 static int eloop_sock_table_dispatch_table(struct eloop_sock_table *table,
315 struct pollfd **pollfds_map,
322 if (!table || !table->table)
326 for (i = 0; i < table->count; i++) {
327 pfd = find_pollfd(pollfds_map, table->table[i].sock,
332 if (!(pfd->revents & revents))
335 table->table[i].handler(table->table[i].sock,
336 table->table[i].eloop_data,
337 table->table[i].user_data);
346 static void eloop_sock_table_dispatch(struct eloop_sock_table *readers,
347 struct eloop_sock_table *writers,
348 struct eloop_sock_table *exceptions,
349 struct pollfd **pollfds_map,
352 if (eloop_sock_table_dispatch_table(readers, pollfds_map,
353 max_pollfd_map, POLLIN | POLLERR |
355 return; /* pollfds may be invalid at this point */
357 if (eloop_sock_table_dispatch_table(writers, pollfds_map,
358 max_pollfd_map, POLLOUT))
359 return; /* pollfds may be invalid at this point */
361 eloop_sock_table_dispatch_table(exceptions, pollfds_map,
362 max_pollfd_map, POLLERR | POLLHUP);
365 #else /* CONFIG_ELOOP_POLL */
367 static void eloop_sock_table_set_fds(struct eloop_sock_table *table,
374 if (table->table == NULL)
377 for (i = 0; i < table->count; i++)
378 FD_SET(table->table[i].sock, fds);
382 static void eloop_sock_table_dispatch(struct eloop_sock_table *table,
387 if (table == NULL || table->table == NULL)
391 for (i = 0; i < table->count; i++) {
392 if (FD_ISSET(table->table[i].sock, fds)) {
393 table->table[i].handler(table->table[i].sock,
394 table->table[i].eloop_data,
395 table->table[i].user_data);
402 #endif /* CONFIG_ELOOP_POLL */
405 static void eloop_sock_table_destroy(struct eloop_sock_table *table)
409 for (i = 0; i < table->count && table->table; i++) {
410 wpa_printf(MSG_INFO, "ELOOP: remaining socket: "
411 "sock=%d eloop_data=%p user_data=%p "
413 table->table[i].sock,
414 table->table[i].eloop_data,
415 table->table[i].user_data,
416 table->table[i].handler);
417 wpa_trace_dump_funcname("eloop unregistered socket "
419 table->table[i].handler);
420 wpa_trace_dump("eloop sock", &table->table[i]);
422 os_free(table->table);
427 int eloop_register_read_sock(int sock, eloop_sock_handler handler,
428 void *eloop_data, void *user_data)
430 return eloop_register_sock(sock, EVENT_TYPE_READ, handler,
431 eloop_data, user_data);
435 void eloop_unregister_read_sock(int sock)
437 eloop_unregister_sock(sock, EVENT_TYPE_READ);
441 static struct eloop_sock_table *eloop_get_sock_table(eloop_event_type type)
444 case EVENT_TYPE_READ:
445 return &eloop.readers;
446 case EVENT_TYPE_WRITE:
447 return &eloop.writers;
448 case EVENT_TYPE_EXCEPTION:
449 return &eloop.exceptions;
456 int eloop_register_sock(int sock, eloop_event_type type,
457 eloop_sock_handler handler,
458 void *eloop_data, void *user_data)
460 struct eloop_sock_table *table;
462 table = eloop_get_sock_table(type);
463 return eloop_sock_table_add_sock(table, sock, handler,
464 eloop_data, user_data);
468 void eloop_unregister_sock(int sock, eloop_event_type type)
470 struct eloop_sock_table *table;
472 table = eloop_get_sock_table(type);
473 eloop_sock_table_remove_sock(table, sock);
477 int eloop_register_timeout(unsigned int secs, unsigned int usecs,
478 eloop_timeout_handler handler,
479 void *eloop_data, void *user_data)
481 struct eloop_timeout *timeout, *tmp;
484 timeout = os_zalloc(sizeof(*timeout));
487 if (os_get_time(&timeout->time) < 0) {
491 now_sec = timeout->time.sec;
492 timeout->time.sec += secs;
493 if (timeout->time.sec < now_sec) {
495 * Integer overflow - assume long enough timeout to be assumed
496 * to be infinite, i.e., the timeout would never happen.
498 wpa_printf(MSG_DEBUG, "ELOOP: Too long timeout (secs=%u) to "
499 "ever happen - ignore it", secs);
503 timeout->time.usec += usecs;
504 while (timeout->time.usec >= 1000000) {
506 timeout->time.usec -= 1000000;
508 timeout->eloop_data = eloop_data;
509 timeout->user_data = user_data;
510 timeout->handler = handler;
511 wpa_trace_add_ref(timeout, eloop, eloop_data);
512 wpa_trace_add_ref(timeout, user, user_data);
513 wpa_trace_record(timeout);
515 /* Maintain timeouts in order of increasing time */
516 dl_list_for_each(tmp, &eloop.timeout, struct eloop_timeout, list) {
517 if (os_time_before(&timeout->time, &tmp->time)) {
518 dl_list_add(tmp->list.prev, &timeout->list);
522 dl_list_add_tail(&eloop.timeout, &timeout->list);
528 static void eloop_remove_timeout(struct eloop_timeout *timeout)
530 dl_list_del(&timeout->list);
531 wpa_trace_remove_ref(timeout, eloop, timeout->eloop_data);
532 wpa_trace_remove_ref(timeout, user, timeout->user_data);
537 int eloop_cancel_timeout(eloop_timeout_handler handler,
538 void *eloop_data, void *user_data)
540 struct eloop_timeout *timeout, *prev;
543 dl_list_for_each_safe(timeout, prev, &eloop.timeout,
544 struct eloop_timeout, list) {
545 if (timeout->handler == handler &&
546 (timeout->eloop_data == eloop_data ||
547 eloop_data == ELOOP_ALL_CTX) &&
548 (timeout->user_data == user_data ||
549 user_data == ELOOP_ALL_CTX)) {
550 eloop_remove_timeout(timeout);
559 int eloop_is_timeout_registered(eloop_timeout_handler handler,
560 void *eloop_data, void *user_data)
562 struct eloop_timeout *tmp;
564 dl_list_for_each(tmp, &eloop.timeout, struct eloop_timeout, list) {
565 if (tmp->handler == handler &&
566 tmp->eloop_data == eloop_data &&
567 tmp->user_data == user_data)
575 #ifndef CONFIG_NATIVE_WINDOWS
576 static void eloop_handle_alarm(int sig)
578 wpa_printf(MSG_ERROR, "eloop: could not process SIGINT or SIGTERM in "
579 "two seconds. Looks like there\n"
580 "is a bug that ends up in a busy loop that "
581 "prevents clean shutdown.\n"
582 "Killing program forcefully.\n");
585 #endif /* CONFIG_NATIVE_WINDOWS */
588 static void eloop_handle_signal(int sig)
592 #ifndef CONFIG_NATIVE_WINDOWS
593 if ((sig == SIGINT || sig == SIGTERM) && !eloop.pending_terminate) {
594 /* Use SIGALRM to break out from potential busy loops that
595 * would not allow the program to be killed. */
596 eloop.pending_terminate = 1;
597 signal(SIGALRM, eloop_handle_alarm);
600 #endif /* CONFIG_NATIVE_WINDOWS */
603 for (i = 0; i < eloop.signal_count; i++) {
604 if (eloop.signals[i].sig == sig) {
605 eloop.signals[i].signaled++;
612 static void eloop_process_pending_signals(void)
616 if (eloop.signaled == 0)
620 if (eloop.pending_terminate) {
621 #ifndef CONFIG_NATIVE_WINDOWS
623 #endif /* CONFIG_NATIVE_WINDOWS */
624 eloop.pending_terminate = 0;
627 for (i = 0; i < eloop.signal_count; i++) {
628 if (eloop.signals[i].signaled) {
629 eloop.signals[i].signaled = 0;
630 eloop.signals[i].handler(eloop.signals[i].sig,
631 eloop.signals[i].user_data);
637 int eloop_register_signal(int sig, eloop_signal_handler handler,
640 struct eloop_signal *tmp;
642 tmp = os_realloc_array(eloop.signals, eloop.signal_count + 1,
643 sizeof(struct eloop_signal));
647 tmp[eloop.signal_count].sig = sig;
648 tmp[eloop.signal_count].user_data = user_data;
649 tmp[eloop.signal_count].handler = handler;
650 tmp[eloop.signal_count].signaled = 0;
651 eloop.signal_count++;
653 signal(sig, eloop_handle_signal);
659 int eloop_register_signal_terminate(eloop_signal_handler handler,
662 int ret = eloop_register_signal(SIGINT, handler, user_data);
664 ret = eloop_register_signal(SIGTERM, handler, user_data);
669 int eloop_register_signal_reconfig(eloop_signal_handler handler,
672 #ifdef CONFIG_NATIVE_WINDOWS
674 #else /* CONFIG_NATIVE_WINDOWS */
675 return eloop_register_signal(SIGHUP, handler, user_data);
676 #endif /* CONFIG_NATIVE_WINDOWS */
682 #ifdef CONFIG_ELOOP_POLL
685 #else /* CONFIG_ELOOP_POLL */
686 fd_set *rfds, *wfds, *efds;
688 #endif /* CONFIG_ELOOP_POLL */
690 struct os_time tv, now;
692 #ifndef CONFIG_ELOOP_POLL
693 rfds = os_malloc(sizeof(*rfds));
694 wfds = os_malloc(sizeof(*wfds));
695 efds = os_malloc(sizeof(*efds));
696 if (rfds == NULL || wfds == NULL || efds == NULL)
698 #endif /* CONFIG_ELOOP_POLL */
700 while (!eloop.terminate &&
701 (!dl_list_empty(&eloop.timeout) || eloop.readers.count > 0 ||
702 eloop.writers.count > 0 || eloop.exceptions.count > 0)) {
703 struct eloop_timeout *timeout;
704 timeout = dl_list_first(&eloop.timeout, struct eloop_timeout,
708 if (os_time_before(&now, &timeout->time))
709 os_time_sub(&timeout->time, &now, &tv);
711 tv.sec = tv.usec = 0;
712 #ifdef CONFIG_ELOOP_POLL
713 timeout_ms = tv.sec * 1000 + tv.usec / 1000;
714 #else /* CONFIG_ELOOP_POLL */
716 _tv.tv_usec = tv.usec;
717 #endif /* CONFIG_ELOOP_POLL */
720 #ifdef CONFIG_ELOOP_POLL
721 num_poll_fds = eloop_sock_table_set_fds(
722 &eloop.readers, &eloop.writers, &eloop.exceptions,
723 eloop.pollfds, eloop.pollfds_map,
724 eloop.max_pollfd_map);
725 res = poll(eloop.pollfds, num_poll_fds,
726 timeout ? timeout_ms : -1);
728 if (res < 0 && errno != EINTR && errno != 0) {
732 #else /* CONFIG_ELOOP_POLL */
733 eloop_sock_table_set_fds(&eloop.readers, rfds);
734 eloop_sock_table_set_fds(&eloop.writers, wfds);
735 eloop_sock_table_set_fds(&eloop.exceptions, efds);
736 res = select(eloop.max_sock + 1, rfds, wfds, efds,
737 timeout ? &_tv : NULL);
738 if (res < 0 && errno != EINTR && errno != 0) {
742 #endif /* CONFIG_ELOOP_POLL */
743 eloop_process_pending_signals();
745 /* check if some registered timeouts have occurred */
746 timeout = dl_list_first(&eloop.timeout, struct eloop_timeout,
750 if (!os_time_before(&now, &timeout->time)) {
751 void *eloop_data = timeout->eloop_data;
752 void *user_data = timeout->user_data;
753 eloop_timeout_handler handler =
755 eloop_remove_timeout(timeout);
756 handler(eloop_data, user_data);
764 #ifdef CONFIG_ELOOP_POLL
765 eloop_sock_table_dispatch(&eloop.readers, &eloop.writers,
766 &eloop.exceptions, eloop.pollfds_map,
767 eloop.max_pollfd_map);
768 #else /* CONFIG_ELOOP_POLL */
769 eloop_sock_table_dispatch(&eloop.readers, rfds);
770 eloop_sock_table_dispatch(&eloop.writers, wfds);
771 eloop_sock_table_dispatch(&eloop.exceptions, efds);
772 #endif /* CONFIG_ELOOP_POLL */
776 #ifndef CONFIG_ELOOP_POLL
780 #endif /* CONFIG_ELOOP_POLL */
785 void eloop_terminate(void)
791 void eloop_destroy(void)
793 struct eloop_timeout *timeout, *prev;
797 dl_list_for_each_safe(timeout, prev, &eloop.timeout,
798 struct eloop_timeout, list) {
800 sec = timeout->time.sec - now.sec;
801 usec = timeout->time.usec - now.usec;
802 if (timeout->time.usec < now.usec) {
806 wpa_printf(MSG_INFO, "ELOOP: remaining timeout: %d.%06d "
807 "eloop_data=%p user_data=%p handler=%p",
808 sec, usec, timeout->eloop_data, timeout->user_data,
810 wpa_trace_dump_funcname("eloop unregistered timeout handler",
812 wpa_trace_dump("eloop timeout", timeout);
813 eloop_remove_timeout(timeout);
815 eloop_sock_table_destroy(&eloop.readers);
816 eloop_sock_table_destroy(&eloop.writers);
817 eloop_sock_table_destroy(&eloop.exceptions);
818 os_free(eloop.signals);
820 #ifdef CONFIG_ELOOP_POLL
821 os_free(eloop.pollfds);
822 os_free(eloop.pollfds_map);
823 #endif /* CONFIG_ELOOP_POLL */
827 int eloop_terminated(void)
829 return eloop.terminate;
833 void eloop_wait_for_read_sock(int sock)
835 #ifdef CONFIG_ELOOP_POLL
841 os_memset(&pfd, 0, sizeof(pfd));
846 #else /* CONFIG_ELOOP_POLL */
854 select(sock + 1, &rfds, NULL, NULL, NULL);
855 #endif /* CONFIG_ELOOP_POLL */