/* $OpenBSD: timer.c,v 1.16 2013/04/02 03:06:18 guenther 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 #include #include #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 timeval **timeout) { struct timeval now; if (TAILQ_FIRST(&events)) { gettimeofday(&now, 0); if (timercmp(&now, &TAILQ_FIRST(&events)->expiration, >=)) timerclear(*timeout); else timersub(&TAILQ_FIRST(&events)->expiration, &now, *timeout); } else *timeout = 0; } void timer_handle_expirations(void) { struct timeval now; struct event *n; gettimeofday(&now, 0); for (n = TAILQ_FIRST(&events); n && timercmp(&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 timeval *expiration) { struct event *ev = (struct event *) malloc(sizeof *ev); struct event *n; struct timeval now; if (!ev) return 0; ev->name = name; ev->func = func; ev->arg = arg; gettimeofday(&now, 0); memcpy(&ev->expiration, expiration, sizeof *expiration); for (n = TAILQ_FIRST(&events); n && timercmp(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 timeval now; gettimeofday(&now, 0); 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 : ""), ev, (int) (ev->expiration.tv_sec - now.tv_sec))); }