X-Git-Url: http://git.meshlink.io/?p=meshlink;a=blobdiff_plain;f=src%2Fevent.c;h=af1b0d60072e2dc19080fde9136f5126d4788d7f;hp=028483bdce515648bfcf33d0906ba0e883e2ceed;hb=529b8fab8c21e7ae5af91d742ff202eab38e51f3;hpb=14979f835df4214a7c2510852f7ffedc9e08c2c0

diff --git a/src/event.c b/src/event.c
index 028483bd..af1b0d60 100644
--- a/src/event.c
+++ b/src/event.c
@@ -1,7 +1,6 @@
 /*
-    event.c -- event queue
-    Copyright (C) 2002 Guus Sliepen <guus@sliepen.warande.net>,
-                  2002 Ivo Timmermans <itimmermans@bigfoot.com>
+    event.c -- I/O, timeout and signal event handling
+    Copyright (C) 2014-2017 Guus Sliepen <guus@meshlink.io>
 
     This program is free software; you can redistribute it and/or modify
     it under the terms of the GNU General Public License as published by
@@ -13,98 +12,357 @@
     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
     GNU General Public License for more details.
 
-    You should have received a copy of the GNU General Public License
-    along with this program; if not, write to the Free Software
-    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
-
-    $Id: event.c,v 1.1.4.2 2002/03/01 14:09:30 guus Exp $
+    You should have received a copy of the GNU General Public License along
+    with this program; if not, write to the Free Software Foundation, Inc.,
+    51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 */
 
-#include "config.h"
-
-#include <stdlib.h>
-#include <xalloc.h>
-#include <string.h>
-#include <utils.h>
-#include <avl_tree.h>
-#include <time.h>
+#include "system.h"
 
+#include "dropin.h"
 #include "event.h"
+#include "net.h"
+#include "splay_tree.h"
+#include "utils.h"
+#include "xalloc.h"
 
-#include "system.h"
+static int io_compare(const io_t *a, const io_t *b) {
+	return a->fd - b->fd;
+}
+
+static int timeout_compare(const timeout_t *a, const timeout_t *b) {
+	struct timeval diff;
+	timersub(&a->tv, &b->tv, &diff);
+
+	if(diff.tv_sec < 0) {
+		return -1;
+	}
+
+	if(diff.tv_sec > 0) {
+		return 1;
+	}
+
+	if(diff.tv_usec < 0) {
+		return -1;
+	}
+
+	if(diff.tv_usec > 0) {
+		return 1;
+	}
+
+	if(a < b) {
+		return -1;
+	}
+
+	if(a > b) {
+		return 1;
+	}
+
+	return 0;
+}
+
+void io_add(event_loop_t *loop, io_t *io, io_cb_t cb, void *data, int fd, int flags) {
+	assert(!io->cb);
+
+	io->fd = fd;
+	io->cb = cb;
+	io->data = data;
+	io->node.data = io;
+
+	io_set(loop, io, flags);
+
+	splay_node_t *node = splay_insert_node(&loop->ios, &io->node);
+	assert(node);
+	(void)node;
+}
+
+void io_set(event_loop_t *loop, io_t *io, int flags) {
+	assert(io->cb);
+
+	io->flags = flags;
+
+	if(flags & IO_READ) {
+		FD_SET(io->fd, &loop->readfds);
+	} else {
+		FD_CLR(io->fd, &loop->readfds);
+	}
+
+	if(flags & IO_WRITE) {
+		FD_SET(io->fd, &loop->writefds);
+	} else {
+		FD_CLR(io->fd, &loop->writefds);
+	}
+}
+
+void io_del(event_loop_t *loop, io_t *io) {
+	assert(io->cb);
+
+	loop->deletion = true;
+
+	io_set(loop, io, 0);
+
+	splay_unlink_node(&loop->ios, &io->node);
+	io->cb = NULL;
+}
+
+void timeout_add(event_loop_t *loop, timeout_t *timeout, timeout_cb_t cb, void *data, struct timeval *tv) {
+	timeout->cb = cb;
+	timeout->data = data;
+	timeout->node.data = timeout;
+
+	timeout_set(loop, timeout, tv);
+}
+
+void timeout_set(event_loop_t *loop, timeout_t *timeout, struct timeval *tv) {
+	assert(timeout->cb);
+
+	if(timerisset(&timeout->tv)) {
+		splay_unlink_node(&loop->timeouts, &timeout->node);
+	}
+
+	if(!loop->now.tv_sec) {
+		gettimeofday(&loop->now, NULL);
+	}
+
+	timeradd(&loop->now, tv, &timeout->tv);
+
+	if(!splay_insert_node(&loop->timeouts, &timeout->node)) {
+		abort();
+	}
+
+	loop->deletion = true;
+}
+
+static void timeout_disable(event_loop_t *loop, timeout_t *timeout) {
+	splay_unlink_node(&loop->timeouts, &timeout->node);
+	timeout->tv = (struct timeval) {
+		0, 0
+	};
+}
+
+void timeout_del(event_loop_t *loop, timeout_t *timeout) {
+	if(!timeout->cb) {
+		return;
+	}
+
+	if(timerisset(&timeout->tv)) {
+		timeout_disable(loop, timeout);
+	}
+
+	timeout->cb = NULL;
+	loop->deletion = true;
+}
+
+static int signal_compare(const signal_t *a, const signal_t *b) {
+	return (int)a->signum - (int)b->signum;
+}
+
+static void signalio_handler(event_loop_t *loop, void *data, int flags) {
+	(void)data;
+	(void)flags;
+	unsigned char signum;
+
+	if(read(loop->pipefd[0], &signum, 1) != 1) {
+		return;
+	}
+
+	signal_t *sig = splay_search(&loop->signals, &(signal_t) {
+		.signum = signum
+	});
+
+	if(sig) {
+		sig->cb(loop, sig->data);
+	}
+}
+
+static void pipe_init(event_loop_t *loop) {
+	int result = pipe(loop->pipefd);
+	assert(result == 0);
+
+	if(result == 0) {
+		io_add(loop, &loop->signalio, signalio_handler, NULL, loop->pipefd[0], IO_READ);
+	}
+}
+
+static void pipe_exit(event_loop_t *loop) {
+	io_del(loop, &loop->signalio);
+
+	close(loop->pipefd[0]);
+	close(loop->pipefd[1]);
+
+	loop->pipefd[0] = -1;
+	loop->pipefd[1] = -1;
+}
+
+void signal_trigger(event_loop_t *loop, signal_t *sig) {
+	uint8_t signum = sig->signum;
+	write(loop->pipefd[1], &signum, 1);
+	return;
+}
+
+void signal_add(event_loop_t *loop, signal_t *sig, signal_cb_t cb, void *data, uint8_t signum) {
+	assert(!sig->cb);
+
+	sig->cb = cb;
+	sig->data = data;
+	sig->signum = signum;
+	sig->node.data = sig;
+
+	if(loop->pipefd[0] == -1) {
+		pipe_init(loop);
+	}
+
+	if(!splay_insert_node(&loop->signals, &sig->node)) {
+		abort();
+	}
+}
+
+void signal_del(event_loop_t *loop, signal_t *sig) {
+	assert(sig->cb);
+
+	loop->deletion = true;
+
+	splay_unlink_node(&loop->signals, &sig->node);
+	sig->cb = NULL;
+
+	if(!loop->signals.count && loop->pipefd[0] != -1) {
+		pipe_exit(loop);
+	}
+}
+
+void idle_set(event_loop_t *loop, idle_cb_t cb, void *data) {
+	loop->idle_cb = cb;
+	loop->idle_data = data;
+}
+
+bool event_loop_run(event_loop_t *loop, pthread_mutex_t *mutex) {
+	assert(mutex);
+
+	fd_set readable;
+	fd_set writable;
+
+	while(loop->running) {
+		gettimeofday(&loop->now, NULL);
+		struct timeval diff, it, *tv = NULL;
+
+		while(loop->timeouts.head) {
+			timeout_t *timeout = loop->timeouts.head->data;
+			timersub(&timeout->tv, &loop->now, &diff);
+
+			if(diff.tv_sec < 0) {
+				timeout_disable(loop, timeout);
+				timeout->cb(loop, timeout->data);
+			} else {
+				tv = &diff;
+				break;
+			}
+		}
+
+		if(loop->idle_cb) {
+			it = loop->idle_cb(loop, loop->idle_data);
+
+			if(it.tv_sec >= 0 && (!tv || timercmp(&it, tv, <))) {
+				tv = &it;
+			}
+		}
+
+		memcpy(&readable, &loop->readfds, sizeof(readable));
+		memcpy(&writable, &loop->writefds, sizeof(writable));
+
+		int fds = 0;
+
+		if(loop->ios.tail) {
+			io_t *last = loop->ios.tail->data;
+			fds = last->fd + 1;
+		}
+
+		// release mesh mutex during select
+		pthread_mutex_unlock(mutex);
+
+		int n = select(fds, &readable, &writable, NULL, tv);
+
+		pthread_mutex_lock(mutex);
+
+		gettimeofday(&loop->now, NULL);
+
+		if(n < 0) {
+			if(sockwouldblock(errno)) {
+				continue;
+			} else {
+				return false;
+			}
+		}
+
+		if(!n) {
+			continue;
+		}
+
+		// Normally, splay_each allows the current node to be deleted. However,
+		// it can be that one io callback triggers the deletion of another io,
+		// so we have to detect this and break the loop.
+
+		loop->deletion = false;
+
+		for splay_each(io_t, io, &loop->ios) {
+			if(FD_ISSET(io->fd, &writable) && io->cb) {
+				io->cb(loop, io->data, IO_WRITE);
+			}
+
+			if(loop->deletion) {
+				break;
+			}
+
+			if(FD_ISSET(io->fd, &readable) && io->cb) {
+				io->cb(loop, io->data, IO_READ);
+			}
+
+			if(loop->deletion) {
+				break;
+			}
+		}
+	}
+
+	return true;
+}
+
+void event_flush_output(event_loop_t *loop) {
+	for splay_each(io_t, io, &loop->ios)
+		if(FD_ISSET(io->fd, &loop->writefds)) {
+			io->cb(loop, io->data, IO_WRITE);
+		}
+}
+
+void event_loop_start(event_loop_t *loop) {
+	loop->running = true;
+}
+
+void event_loop_stop(event_loop_t *loop) {
+	loop->running = false;
+}
+
+void event_loop_init(event_loop_t *loop) {
+	loop->ios.compare = (splay_compare_t)io_compare;
+	loop->timeouts.compare = (splay_compare_t)timeout_compare;
+	loop->signals.compare = (splay_compare_t)signal_compare;
+	loop->pipefd[0] = -1;
+	loop->pipefd[1] = -1;
+	gettimeofday(&loop->now, NULL);
+}
+
+void event_loop_exit(event_loop_t *loop) {
+	assert(!loop->ios.count);
+	assert(!loop->timeouts.count);
+	assert(!loop->signals.count);
+
+	for splay_each(io_t, io, &loop->ios) {
+		splay_unlink_node(&loop->ios, node);
+	}
+
+	for splay_each(timeout_t, timeout, &loop->timeouts) {
+		splay_unlink_node(&loop->timeouts, node);
+	}
 
-avl_tree_t *event_tree;
-extern time_t now;
-
-int id;
-
-int event_compare(event_t *a, event_t *b)
-{
-  if(a->time > b->time)
-    return 1;
-  if(a->time < b->time)
-    return -1;
-  return a->id - b->id; 
-}
-
-void init_events(void)
-{
-cp
-  event_tree = avl_alloc_tree((avl_compare_t)event_compare, NULL);
-cp
-}
-
-void exit_events(void)
-{
-cp
-  avl_delete_tree(event_tree);
-cp
-}
-
-event_t *new_event(void)
-{
-  event_t *event;
-cp
-  event = (event_t *)xmalloc_and_zero(sizeof(*event));
-cp
-  return event;
-}
-
-void free_event(event_t *event)
-{
-cp
-  free(event);
-cp
-}
-
-void event_add(event_t *event)
-{
-cp
-  event->id = ++id;
-  avl_insert(event_tree, event);
-cp
-}
-
-void event_del(event_t *event)
-{
-cp
-  avl_delete(event_tree, event);
-cp
-}
-
-event_t *get_expired_event(void)
-{
-  event_t *event;
-cp
-  if(event_tree->head)
-  {
-    event = (event_t *)event_tree->head->data;
-    if(event->time < now)
-    {
-      avl_delete(event_tree, event);
-      return event;
-    }
-  }
-cp  
-  return NULL;
+	for splay_each(signal_t, signal, &loop->signals) {
+		splay_unlink_node(&loop->signals, node);
+	}
 }