1 /* $OpenBSD: timer.c,v 1.18 2017/12/05 20:31:45 jca Exp $ */ 2 /* $EOM: timer.c,v 1.13 2000/02/20 19:58:42 niklas Exp $ */ 3 4 /* 5 * Copyright (c) 1998, 1999 Niklas Hallqvist. All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 21 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 22 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 23 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 24 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 25 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 26 */ 27 28 /* 29 * This code was written under funding by Ericsson Radio Systems. 30 */ 31 32 #include <sys/queue.h> 33 #include <sys/time.h> 34 35 #include <stdlib.h> 36 #include <string.h> 37 38 #include "log.h" 39 #include "timer.h" 40 41 static TAILQ_HEAD(event_list, event) events; 42 43 void 44 timer_init(void) 45 { 46 TAILQ_INIT(&events); 47 } 48 49 void 50 timer_next_event(struct timespec **timeout) 51 { 52 struct timespec now; 53 54 if (TAILQ_FIRST(&events)) { 55 clock_gettime(CLOCK_MONOTONIC, &now); 56 if (timespeccmp(&now, &TAILQ_FIRST(&events)->expiration, >=)) 57 timespecclear(*timeout); 58 else 59 timespecsub(&TAILQ_FIRST(&events)->expiration, &now, 60 *timeout); 61 } else 62 *timeout = 0; 63 } 64 65 void 66 timer_handle_expirations(void) 67 { 68 struct timespec now; 69 struct event *n; 70 71 clock_gettime(CLOCK_MONOTONIC, &now); 72 for (n = TAILQ_FIRST(&events); 73 n && timespeccmp(&now, &n->expiration, >=); 74 n = TAILQ_FIRST(&events)) { 75 LOG_DBG((LOG_TIMER, 10, 76 "timer_handle_expirations: event %s(%p)", n->name, 77 n->arg)); 78 TAILQ_REMOVE(&events, n, link); 79 (*n->func)(n->arg); 80 free(n); 81 } 82 } 83 84 struct event * 85 timer_add_event(char *name, void (*func)(void *), void *arg, 86 struct timespec *expiration) 87 { 88 struct event *ev = malloc(sizeof *ev); 89 struct event *n; 90 struct timespec now; 91 92 if (!ev) 93 return 0; 94 ev->name = name; 95 ev->func = func; 96 ev->arg = arg; 97 clock_gettime(CLOCK_MONOTONIC, &now); 98 memcpy(&ev->expiration, expiration, sizeof *expiration); 99 for (n = TAILQ_FIRST(&events); 100 n && timespeccmp(expiration, &n->expiration, >=); 101 n = TAILQ_NEXT(n, link)) 102 ; 103 if (n) { 104 LOG_DBG((LOG_TIMER, 10, 105 "timer_add_event: event %s(%p) added before %s(%p), " 106 "expiration in %llds", name, arg, n->name, n->arg, 107 (long long)(expiration->tv_sec - now.tv_sec))); 108 TAILQ_INSERT_BEFORE(n, ev, link); 109 } else { 110 LOG_DBG((LOG_TIMER, 10, "timer_add_event: event %s(%p) added " 111 "last, expiration in %ds", name, arg, 112 (int)(expiration->tv_sec - now.tv_sec))); 113 TAILQ_INSERT_TAIL(&events, ev, link); 114 } 115 return ev; 116 } 117 118 void 119 timer_remove_event(struct event *ev) 120 { 121 LOG_DBG((LOG_TIMER, 10, "timer_remove_event: removing event %s(%p)", 122 ev->name, ev->arg)); 123 TAILQ_REMOVE(&events, ev, link); 124 free(ev); 125 } 126 127 void 128 timer_report(void) 129 { 130 struct event *ev; 131 struct timespec now; 132 133 clock_gettime(CLOCK_MONOTONIC, &now); 134 135 for (ev = TAILQ_FIRST(&events); ev; ev = TAILQ_NEXT(ev, link)) 136 LOG_DBG((LOG_REPORT, 0, 137 "timer_report: event %s(%p) scheduled in %d seconds", 138 (ev->name ? ev->name : "<unknown>"), ev, 139 (int) (ev->expiration.tv_sec - now.tv_sec))); 140 } 141