root/sbin/isakmpd/timer.c
/* $OpenBSD: timer.c,v 1.18 2017/12/05 20:31:45 jca Exp $        */
/* $EOM: timer.c,v 1.13 2000/02/20 19:58:42 niklas Exp $         */

/*
 * Copyright (c) 1998, 1999 Niklas Hallqvist.  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 AUTHOR ``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 AUTHOR 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.
 */

/*
 * This code was written under funding by Ericsson Radio Systems.
 */

#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)));
}