1 files changed, 78 insertions, 0 deletions
diff --git a/mmss/queue.cpp b/mmss/queue.cpp
new file mode 100644
index 0000000..a5d2142
--- /dev/null
+++ b/mmss/queue.cpp
@@ -0,0 +1,78 @@
+/*
+  Copyright (c) 2013, Matthias Schiffer <mschiffer@universe-factory.net>
+  All rights reserved.
+
+  Redistribution and use in source and binary forms, with or without
+  modification, are permitted provided that the following conditions are met:
+
+    1. Redistributions of source code must retain the above copyright notice,
+       this list of conditions and the following disclaimer.
+    2. Redistributions in binary form must reproduce the above copyright notice,
+       this list of conditions and the following disclaimer in the documentation
+       and/or other materials provided with the distribution.
+
+  THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+  AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+  DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
+  FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
+  DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
+  SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
+  CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+  OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
+  OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+*/
+
+
+#include "queue.hpp"
+#include "mmss.hpp"
+
+#include <cstdlib>
+
+
+typedef struct mmss_queue_entry mmss_queue_entry_t;
+
+struct mmss_queue_entry {
+	mmss_queue_entry_t *next;
+	uint64_t timeout;
+	void *data;
+};
+
+
+void mmss_queue_put(mmss_t *mmss, mmss_queue_t *queue, void *data, uint64_t timeout) {
+	while (*queue && timeout >= (*queue)->timeout)
+		queue = &(*queue)->next;
+
+	mmss_queue_entry_t *entry = new mmss_queue_entry_t;
+
+	entry->timeout = timeout;
+	entry->data = data;
+
+	entry->next = *queue;
+	*queue = entry;
+}
+
+void* mmss_queue_get(mmss_t *mmss, mmss_queue_t *queue) {
+	mmss_queue_entry_t *entry = *queue;
+
+	if (!entry || entry->timeout > mmss->now)
+		return NULL;
+
+	*queue = entry->next;
+	void *data = entry->data;
+	free(entry);
+
+	return data;
+}
+
+int mmss_queue_timeout(const mmss_t *mmss, const mmss_queue_t *const queue) {
+	if (!*queue)
+		return -1;
+
+	int diff = (*queue)->timeout - mmss->now;
+
+	if (diff < 0)
+		return 0;
+	else
+		return diff;
+}