From 6c2649ab27f96dcc40a1f01a36a07d1603f39c51 Mon Sep 17 00:00:00 2001 From: Matthias Schiffer Date: Mon, 27 Feb 2012 23:12:56 +0100 Subject: Add timeout to task queue --- src/queue.c | 89 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 89 insertions(+) create mode 100644 src/queue.c (limited to 'src/queue.c') diff --git a/src/queue.c b/src/queue.c new file mode 100644 index 0000000..79f4e96 --- /dev/null +++ b/src/queue.c @@ -0,0 +1,89 @@ +/* + Copyright (c) 2012, Matthias Schiffer + Partly based on QuickTun Copyright (c) 2010, Ivo Smits . + 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.h" + +#include + + +static inline int after(const struct timespec *tp1, const struct timespec *tp2) { + return (tp1->tv_sec > tp2->tv_sec || + (tp1->tv_sec == tp2->tv_sec && tp1->tv_nsec > tp2->tv_nsec)); +} + +void fastd_queue_put(fastd_queue *queue, void *data, int timeout) { + fastd_queue_entry *entry = malloc(sizeof(fastd_queue_entry)); + entry->data = data; + entry->timeout = (struct timespec){ 0, 0 }; + + if (timeout) { + clock_gettime(CLOCK_MONOTONIC, &entry->timeout); + + entry->timeout.tv_sec += timeout/1000; + entry->timeout.tv_nsec += (timeout%1000)*1e6; + + if (entry->timeout.tv_nsec > 1e9) { + entry->timeout.tv_sec++; + entry->timeout.tv_nsec -= 1e9; + } + } + + fastd_queue_entry **current; + for (current = &queue->head;; current = &(*current)->next) { + if (!(*current) || after(&(*current)->timeout, &entry->timeout)) { + entry->next = *current; + *current = entry; + break; + } + } +} + +void* fastd_queue_get(fastd_queue *queue) { + if (!queue->head || fastd_queue_timeout(queue) > 0) + return NULL; + + fastd_queue_entry *entry = queue->head; + queue->head = entry->next; + + void *data = entry->data; + free(entry); + return data; +} + +int fastd_queue_timeout(fastd_queue *queue) { + if (!queue->head) + return -1; + + struct timespec tp; + clock_gettime(CLOCK_MONOTONIC, &tp); + + int64_t diff_msec = ((int64_t)(queue->head->timeout.tv_sec-tp.tv_sec))*1000 - (queue->head->timeout.tv_nsec-tp.tv_nsec)/1e6; + if (diff_msec < 0) + return 0; + else + return (int)diff_msec; +} -- cgit v1.2.3