timer.c revision 1.16 1 1.16 roy /* $NetBSD: timer.c,v 1.16 2018/04/20 13:27:45 roy Exp $ */
2 1.9 rpaulo /* $KAME: timer.c,v 1.11 2005/04/14 06:22:35 suz Exp $ */
3 1.2 itojun
4 1.1 itojun /*
5 1.1 itojun * Copyright (C) 1998 WIDE Project.
6 1.1 itojun * All rights reserved.
7 1.15 roy *
8 1.1 itojun * Redistribution and use in source and binary forms, with or without
9 1.1 itojun * modification, are permitted provided that the following conditions
10 1.1 itojun * are met:
11 1.1 itojun * 1. Redistributions of source code must retain the above copyright
12 1.1 itojun * notice, this list of conditions and the following disclaimer.
13 1.1 itojun * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 itojun * notice, this list of conditions and the following disclaimer in the
15 1.1 itojun * documentation and/or other materials provided with the distribution.
16 1.1 itojun * 3. Neither the name of the project nor the names of its contributors
17 1.1 itojun * may be used to endorse or promote products derived from this software
18 1.1 itojun * without specific prior written permission.
19 1.15 roy *
20 1.1 itojun * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
21 1.1 itojun * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22 1.1 itojun * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23 1.1 itojun * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
24 1.1 itojun * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25 1.1 itojun * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26 1.1 itojun * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27 1.1 itojun * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28 1.1 itojun * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29 1.1 itojun * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30 1.1 itojun * SUCH DAMAGE.
31 1.1 itojun */
32 1.1 itojun
33 1.10 roy #include <sys/queue.h>
34 1.1 itojun #include <sys/time.h>
35 1.1 itojun
36 1.12 roy #include <limits.h>
37 1.1 itojun #include <unistd.h>
38 1.1 itojun #include <syslog.h>
39 1.16 roy #include <stdbool.h>
40 1.1 itojun #include <stdlib.h>
41 1.1 itojun #include <string.h>
42 1.1 itojun #include <search.h>
43 1.1 itojun #include "timer.h"
44 1.14 christos #include "logit.h"
45 1.13 ozaki #include "prog_ops.h"
46 1.1 itojun
47 1.10 roy struct rtadvd_timer_head_t ra_timer = TAILQ_HEAD_INITIALIZER(ra_timer);
48 1.12 roy static struct timespec tm_limit = { LONG_MAX, 1000000000L - 1 };
49 1.12 roy static struct timespec tm_max;
50 1.1 itojun
51 1.1 itojun void
52 1.10 roy rtadvd_timer_init(void)
53 1.1 itojun {
54 1.1 itojun
55 1.10 roy TAILQ_INIT(&ra_timer);
56 1.10 roy tm_max = tm_limit;
57 1.1 itojun }
58 1.1 itojun
59 1.1 itojun struct rtadvd_timer *
60 1.10 roy rtadvd_add_timer(struct rtadvd_timer *(*timeout) (void *),
61 1.12 roy void (*update) (void *, struct timespec *),
62 1.9 rpaulo void *timeodata, void *updatedata)
63 1.1 itojun {
64 1.1 itojun struct rtadvd_timer *newtimer;
65 1.1 itojun
66 1.1 itojun if ((newtimer = malloc(sizeof(*newtimer))) == NULL) {
67 1.14 christos logit(LOG_ERR,
68 1.8 itojun "<%s> can't allocate memory", __func__);
69 1.1 itojun exit(1);
70 1.1 itojun }
71 1.1 itojun
72 1.1 itojun memset(newtimer, 0, sizeof(*newtimer));
73 1.1 itojun
74 1.1 itojun if (timeout == NULL) {
75 1.14 christos logit(LOG_ERR,
76 1.8 itojun "<%s> timeout function unspecified", __func__);
77 1.1 itojun exit(1);
78 1.1 itojun }
79 1.1 itojun newtimer->expire = timeout;
80 1.1 itojun newtimer->update = update;
81 1.1 itojun newtimer->expire_data = timeodata;
82 1.1 itojun newtimer->update_data = updatedata;
83 1.1 itojun newtimer->tm = tm_max;
84 1.1 itojun
85 1.1 itojun /* link into chain */
86 1.10 roy TAILQ_INSERT_TAIL(&ra_timer, newtimer, next);
87 1.1 itojun
88 1.1 itojun return(newtimer);
89 1.1 itojun }
90 1.1 itojun
91 1.1 itojun void
92 1.4 itojun rtadvd_remove_timer(struct rtadvd_timer **timer)
93 1.4 itojun {
94 1.10 roy
95 1.11 roy if (*timer) {
96 1.11 roy TAILQ_REMOVE(&ra_timer, *timer, next);
97 1.11 roy free(*timer);
98 1.11 roy *timer = NULL;
99 1.11 roy }
100 1.4 itojun }
101 1.4 itojun
102 1.4 itojun void
103 1.12 roy rtadvd_set_timer(struct timespec *tm, struct rtadvd_timer *timer)
104 1.1 itojun {
105 1.12 roy struct timespec now;
106 1.1 itojun
107 1.1 itojun /* reset the timer */
108 1.13 ozaki prog_clock_gettime(CLOCK_MONOTONIC, &now);
109 1.12 roy timespecadd(&now, tm, &timer->tm);
110 1.1 itojun
111 1.12 roy /* upate the next expiration time */
112 1.12 roy if (timespeccmp(&timer->tm, &tm_max, <))
113 1.10 roy tm_max = timer->tm;
114 1.16 roy
115 1.16 roy /* enable the timer */
116 1.16 roy timer->enabled = true;
117 1.1 itojun }
118 1.1 itojun
119 1.1 itojun /*
120 1.9 rpaulo * Check expiration for each timer. If a timer expires,
121 1.1 itojun * call the expire function for the timer and update the timer.
122 1.1 itojun * Return the next interval for select() call.
123 1.1 itojun */
124 1.12 roy struct timespec *
125 1.10 roy rtadvd_check_timer(void)
126 1.1 itojun {
127 1.12 roy static struct timespec returnval;
128 1.12 roy struct timespec now;
129 1.11 roy struct rtadvd_timer *tm, *tmn;
130 1.1 itojun
131 1.13 ozaki prog_clock_gettime(CLOCK_MONOTONIC, &now);
132 1.10 roy tm_max = tm_limit;
133 1.1 itojun
134 1.11 roy TAILQ_FOREACH_SAFE(tm, &ra_timer, next, tmn) {
135 1.16 roy if (!tm->enabled)
136 1.16 roy continue;
137 1.12 roy if (timespeccmp(&tm->tm, &now, <=)) {
138 1.9 rpaulo if ((*tm->expire)(tm->expire_data) == NULL)
139 1.9 rpaulo continue; /* the timer was removed */
140 1.9 rpaulo if (tm->update)
141 1.9 rpaulo (*tm->update)(tm->update_data, &tm->tm);
142 1.12 roy timespecadd(&tm->tm, &now, &tm->tm);
143 1.1 itojun }
144 1.12 roy if (timespeccmp(&tm->tm, &tm_max, <))
145 1.10 roy tm_max = tm->tm;
146 1.1 itojun }
147 1.1 itojun
148 1.12 roy if (timespeccmp(&tm_max, &tm_limit, ==))
149 1.4 itojun return(NULL);
150 1.12 roy if (timespeccmp(&tm_max, &now, <)) {
151 1.1 itojun /* this may occur when the interval is too small */
152 1.12 roy timespecclear(&returnval);
153 1.5 itojun } else
154 1.12 roy timespecsub(&tm_max, &now, &returnval);
155 1.1 itojun return(&returnval);
156 1.1 itojun }
157 1.1 itojun
158 1.12 roy struct timespec *
159 1.1 itojun rtadvd_timer_rest(struct rtadvd_timer *timer)
160 1.1 itojun {
161 1.12 roy static struct timespec returnval;
162 1.12 roy struct timespec now;
163 1.1 itojun
164 1.13 ozaki prog_clock_gettime(CLOCK_MONOTONIC, &now);
165 1.12 roy if (timespeccmp(&timer->tm, &now, <=)) {
166 1.16 roy if (timer->enabled)
167 1.16 roy logit(LOG_DEBUG,
168 1.16 roy "<%s> a timer must be expired, but not yet",
169 1.16 roy __func__);
170 1.12 roy returnval.tv_sec = 0;
171 1.12 roy returnval.tv_nsec = 0;
172 1.1 itojun }
173 1.1 itojun else
174 1.12 roy timespecsub(&timer->tm, &now, &returnval);
175 1.1 itojun
176 1.1 itojun return(&returnval);
177 1.1 itojun }
178