Annotation of embedaddon/ipsec-tools/src/racoon/schedule.c, revision 1.1
1.1 ! misho 1: /* $NetBSD: schedule.c,v 1.7 2009/01/23 09:10:13 tteras Exp $ */
! 2:
! 3: /* $KAME: schedule.c,v 1.19 2001/11/05 10:53:19 sakane Exp $ */
! 4:
! 5: /*
! 6: * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
! 7: * Copyright (C) 2008 Timo Teras.
! 8: * All rights reserved.
! 9: *
! 10: * Redistribution and use in source and binary forms, with or without
! 11: * modification, are permitted provided that the following conditions
! 12: * are met:
! 13: * 1. Redistributions of source code must retain the above copyright
! 14: * notice, this list of conditions and the following disclaimer.
! 15: * 2. Redistributions in binary form must reproduce the above copyright
! 16: * notice, this list of conditions and the following disclaimer in the
! 17: * documentation and/or other materials provided with the distribution.
! 18: * 3. Neither the name of the project nor the names of its contributors
! 19: * may be used to endorse or promote products derived from this software
! 20: * without specific prior written permission.
! 21: *
! 22: * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
! 23: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
! 24: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
! 25: * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
! 26: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
! 27: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
! 28: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
! 29: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
! 30: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
! 31: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
! 32: * SUCH DAMAGE.
! 33: */
! 34:
! 35: #include "config.h"
! 36:
! 37: #include <sys/types.h>
! 38: #include <sys/param.h>
! 39: #include <sys/time.h>
! 40: #include <sys/queue.h>
! 41: #include <sys/socket.h>
! 42:
! 43: #include <stdlib.h>
! 44: #include <unistd.h>
! 45: #include <stdio.h>
! 46: #include <string.h>
! 47: #include <errno.h>
! 48: #include <time.h>
! 49:
! 50: #include "misc.h"
! 51: #include "plog.h"
! 52: #include "schedule.h"
! 53: #include "var.h"
! 54: #include "gcmalloc.h"
! 55:
! 56: #ifndef TAILQ_FOREACH
! 57: #define TAILQ_FOREACH(elm, head, field) \
! 58: for (elm = TAILQ_FIRST(head); elm; elm = TAILQ_NEXT(elm, field))
! 59: #endif
! 60:
! 61: static TAILQ_HEAD(_schedtree, sched) sctree;
! 62:
! 63: void
! 64: sched_get_monotonic_time(tv)
! 65: struct timeval *tv;
! 66: {
! 67: #ifdef HAVE_CLOCK_MONOTONIC
! 68: struct timespec ts;
! 69:
! 70: clock_gettime(CLOCK_MONOTONIC, &ts);
! 71: tv->tv_sec = ts.tv_sec;
! 72: tv->tv_usec = ts.tv_nsec / 1000;
! 73: #else
! 74: gettimeofday(tv, NULL);
! 75: #endif
! 76: }
! 77:
! 78: time_t
! 79: sched_monotonic_to_time_t(tv, now)
! 80: struct timeval *tv, *now;
! 81: {
! 82: #ifdef HAVE_CLOCK_MONOTONIC
! 83: struct timeval mynow, res;
! 84:
! 85: if (now == NULL) {
! 86: sched_get_monotonic_time(&mynow);
! 87: now = &mynow;
! 88: }
! 89: timersub(now, tv, &res);
! 90:
! 91: return time(NULL) + res.tv_sec;
! 92: #else
! 93: return tv->tv_sec;
! 94: #endif
! 95: }
! 96:
! 97: /*
! 98: * schedule handler
! 99: * OUT:
! 100: * time to block until next event.
! 101: * if no entry, NULL returned.
! 102: */
! 103: struct timeval *
! 104: schedular()
! 105: {
! 106: static struct timeval timeout;
! 107: struct timeval now;
! 108: struct sched *p;
! 109:
! 110: sched_get_monotonic_time(&now);
! 111: while (!TAILQ_EMPTY(&sctree) &&
! 112: timercmp(&TAILQ_FIRST(&sctree)->xtime, &now, <=)) {
! 113: void (*func)(struct sched *);
! 114:
! 115: p = TAILQ_FIRST(&sctree);
! 116: func = p->func;
! 117: sched_cancel(p);
! 118: func(p);
! 119: }
! 120:
! 121: p = TAILQ_FIRST(&sctree);
! 122: if (p == NULL)
! 123: return NULL;
! 124:
! 125: timersub(&p->xtime, &now, &timeout);
! 126:
! 127: return &timeout;
! 128: }
! 129:
! 130: /*
! 131: * add new schedule to schedule table.
! 132: */
! 133: void
! 134: sched_schedule(sc, tick, func)
! 135: struct sched *sc;
! 136: time_t tick;
! 137: void (*func) __P((struct sched *));
! 138: {
! 139: static long id = 1;
! 140: struct sched *p;
! 141: struct timeval now;
! 142:
! 143: sched_cancel(sc);
! 144:
! 145: sc->func = func;
! 146: sc->id = id++;
! 147: sc->tick.tv_sec = tick;
! 148: sc->tick.tv_usec = 0;
! 149: sched_get_monotonic_time(&now);
! 150: timeradd(&now, &sc->tick, &sc->xtime);
! 151:
! 152: /* add to schedule table */
! 153: TAILQ_FOREACH(p, &sctree, chain) {
! 154: if (timercmp(&sc->xtime, &p->xtime, <))
! 155: break;
! 156: }
! 157: if (p == NULL)
! 158: TAILQ_INSERT_TAIL(&sctree, sc, chain);
! 159: else
! 160: TAILQ_INSERT_BEFORE(p, sc, chain);
! 161: }
! 162:
! 163: /*
! 164: * cancel scheduled callback
! 165: */
! 166: void
! 167: sched_cancel(sc)
! 168: struct sched *sc;
! 169: {
! 170: if (sc->func != NULL) {
! 171: TAILQ_REMOVE(&sctree, sc, chain);
! 172: sc->func = NULL;
! 173: }
! 174: }
! 175:
! 176: /*
! 177: * for debug
! 178: */
! 179: int
! 180: sched_dump(buf, len)
! 181: caddr_t *buf;
! 182: int *len;
! 183: {
! 184: caddr_t new;
! 185: struct sched *p;
! 186: struct scheddump *dst;
! 187: struct timeval now, created;
! 188: int cnt = 0;
! 189:
! 190: /* initialize */
! 191: *len = 0;
! 192: *buf = NULL;
! 193:
! 194: TAILQ_FOREACH(p, &sctree, chain)
! 195: cnt++;
! 196:
! 197: /* no entry */
! 198: if (cnt == 0)
! 199: return -1;
! 200:
! 201: *len = cnt * sizeof(*dst);
! 202:
! 203: new = racoon_malloc(*len);
! 204: if (new == NULL)
! 205: return -1;
! 206: dst = (struct scheddump *)new;
! 207:
! 208: sched_get_monotonic_time(&now);
! 209: p = TAILQ_FIRST(&sctree);
! 210: while (p) {
! 211: timersub(&p->xtime, &p->tick, &created);
! 212: dst->xtime = p->xtime.tv_sec;
! 213: dst->id = p->id;
! 214: dst->created = sched_monotonic_to_time_t(&created, &now);
! 215: dst->tick = p->tick.tv_sec;
! 216:
! 217: p = TAILQ_NEXT(p, chain);
! 218: if (p == NULL)
! 219: break;
! 220: dst++;
! 221: }
! 222:
! 223: *buf = new;
! 224:
! 225: return 0;
! 226: }
! 227:
! 228: /* initialize schedule table */
! 229: void
! 230: sched_init()
! 231: {
! 232: TAILQ_INIT(&sctree);
! 233: }
! 234:
! 235: #ifdef STEST
! 236: #include <sys/types.h>
! 237: #include <sys/time.h>
! 238: #include <unistd.h>
! 239: #include <err.h>
! 240:
! 241: void
! 242: test(tick)
! 243: int *tick;
! 244: {
! 245: printf("execute %d\n", *tick);
! 246: racoon_free(tick);
! 247: }
! 248:
! 249: void
! 250: getstdin()
! 251: {
! 252: int *tick;
! 253: char buf[16];
! 254:
! 255: read(0, buf, sizeof(buf));
! 256: if (buf[0] == 'd') {
! 257: struct scheddump *scbuf, *p;
! 258: int len;
! 259: sched_dump((caddr_t *)&scbuf, &len);
! 260: if (scbuf == NULL)
! 261: return;
! 262: for (p = scbuf; len; p++) {
! 263: printf("xtime=%ld\n", p->xtime);
! 264: len -= sizeof(*p);
! 265: }
! 266: racoon_free(scbuf);
! 267: return;
! 268: }
! 269:
! 270: tick = (int *)racoon_malloc(sizeof(*tick));
! 271: *tick = atoi(buf);
! 272: printf("new queue tick = %d\n", *tick);
! 273: sched_new(*tick, test, tick);
! 274: }
! 275:
! 276: int
! 277: main()
! 278: {
! 279: static fd_set mask0;
! 280: int nfds = 0;
! 281: fd_set rfds;
! 282: struct timeval *timeout;
! 283: int error;
! 284:
! 285: FD_ZERO(&mask0);
! 286: FD_SET(0, &mask0);
! 287: nfds = 1;
! 288:
! 289: /* initialize */
! 290: sched_init();
! 291:
! 292: while (1) {
! 293: rfds = mask0;
! 294:
! 295: timeout = schedular();
! 296:
! 297: error = select(nfds, &rfds, (fd_set *)0, (fd_set *)0, timeout);
! 298: if (error < 0) {
! 299: switch (errno) {
! 300: case EINTR: continue;
! 301: default:
! 302: err(1, "select");
! 303: }
! 304: /*NOTREACHED*/
! 305: }
! 306:
! 307: if (FD_ISSET(0, &rfds))
! 308: getstdin();
! 309: }
! 310: }
! 311: #endif
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to schedule.c CVS log ![[TXT]](/icons/cvsweb/text.gif){kind=icon}
![[DIR]](/icons/cvsweb/dir.gif){kind=icon}
Up to [ELWIX - Embedded LightWeight unIX -] / embedaddon / ipsec-tools / src / racoon