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