#include <sys/queue.h>
#include <sys/time.h>
#include <stdlib.h>
#include <string.h>
#include "log.h"
#include "timer.h"
static TAILQ_HEAD(event_list, event) events;
void
timer_init(void)
{
TAILQ_INIT(&events);
}
void
timer_next_event(struct timespec **timeout)
{
struct timespec now;
if (TAILQ_FIRST(&events)) {
clock_gettime(CLOCK_MONOTONIC, &now);
if (timespeccmp(&now, &TAILQ_FIRST(&events)->expiration, >=))
timespecclear(*timeout);
else
timespecsub(&TAILQ_FIRST(&events)->expiration, &now,
*timeout);
} else
*timeout = 0;
}
void
timer_handle_expirations(void)
{
struct timespec now;
struct event *n;
clock_gettime(CLOCK_MONOTONIC, &now);
for (n = TAILQ_FIRST(&events);
n && timespeccmp(&now, &n->expiration, >=);
n = TAILQ_FIRST(&events)) {
LOG_DBG((LOG_TIMER, 10,
"timer_handle_expirations: event %s(%p)", n->name,
n->arg));
TAILQ_REMOVE(&events, n, link);
(*n->func)(n->arg);
free(n);
}
}
struct event *
timer_add_event(char *name, void (*func)(void *), void *arg,
struct timespec *expiration)
{
struct event *ev = malloc(sizeof *ev);
struct event *n;
struct timespec now;
if (!ev)
return 0;
ev->name = name;
ev->func = func;
ev->arg = arg;
clock_gettime(CLOCK_MONOTONIC, &now);
memcpy(&ev->expiration, expiration, sizeof *expiration);
for (n = TAILQ_FIRST(&events);
n && timespeccmp(expiration, &n->expiration, >=);
n = TAILQ_NEXT(n, link))
;
if (n) {
LOG_DBG((LOG_TIMER, 10,
"timer_add_event: event %s(%p) added before %s(%p), "
"expiration in %llds", name, arg, n->name, n->arg,
(long long)(expiration->tv_sec - now.tv_sec)));
TAILQ_INSERT_BEFORE(n, ev, link);
} else {
LOG_DBG((LOG_TIMER, 10, "timer_add_event: event %s(%p) added "
"last, expiration in %ds", name, arg,
(int)(expiration->tv_sec - now.tv_sec)));
TAILQ_INSERT_TAIL(&events, ev, link);
}
return ev;
}
void
timer_remove_event(struct event *ev)
{
LOG_DBG((LOG_TIMER, 10, "timer_remove_event: removing event %s(%p)",
ev->name, ev->arg));
TAILQ_REMOVE(&events, ev, link);
free(ev);
}
void
timer_report(void)
{
struct event *ev;
struct timespec now;
clock_gettime(CLOCK_MONOTONIC, &now);
for (ev = TAILQ_FIRST(&events); ev; ev = TAILQ_NEXT(ev, link))
LOG_DBG((LOG_REPORT, 0,
"timer_report: event %s(%p) scheduled in %d seconds",
(ev->name ? ev->name : "<unknown>"), ev,
(int) (ev->expiration.tv_sec - now.tv_sec)));
}