timer.c revision 156414
1156136Sdavidxu/* 2156136Sdavidxu * Copyright (c) 2006 David Xu <davidxu@freebsd.org> 3156136Sdavidxu * All rights reserved. 4156136Sdavidxu * 5156136Sdavidxu * Redistribution and use in source and binary forms, with or without 6156136Sdavidxu * modification, are permitted provided that the following conditions 7156136Sdavidxu * are met: 8156136Sdavidxu * 1. Redistributions of source code must retain the above copyright 9156136Sdavidxu * notice unmodified, this list of conditions, and the following 10156136Sdavidxu * disclaimer. 11156136Sdavidxu * 2. Redistributions in binary form must reproduce the above copyright 12156136Sdavidxu * notice, this list of conditions and the following disclaimer in the 13156136Sdavidxu * documentation and/or other materials provided with the distribution. 14156136Sdavidxu * 15156136Sdavidxu * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16156136Sdavidxu * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17156136Sdavidxu * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18156136Sdavidxu * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19156136Sdavidxu * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 20156136Sdavidxu * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21156136Sdavidxu * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22156136Sdavidxu * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23156136Sdavidxu * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24156136Sdavidxu * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25156136Sdavidxu * 26156136Sdavidxu * $FreeBSD: head/lib/librt/timer.c 156414 2006-03-08 00:34:54Z davidxu $ 27156136Sdavidxu * 28156136Sdavidxu */ 29156136Sdavidxu 30156136Sdavidxu#include <sys/cdefs.h> 31156136Sdavidxu#include <sys/types.h> 32156136Sdavidxu#include <sys/syscall.h> 33156136Sdavidxu 34156136Sdavidxu#include "namespace.h" 35156136Sdavidxu#include <errno.h> 36156136Sdavidxu#include <stddef.h> 37156136Sdavidxu#include <signal.h> 38156136Sdavidxu#include <stdlib.h> 39156136Sdavidxu#include <time.h> 40156136Sdavidxu#include "sigev_thread.h" 41156136Sdavidxu#include "un-namespace.h" 42156136Sdavidxu 43156136Sdavidxuextern int __sys_ktimer_create(clockid_t, struct sigevent *__restrict, 44156136Sdavidxu int *__restrict); 45156136Sdavidxuextern int __sys_ktimer_delete(int); 46156136Sdavidxuextern int __sys_ktimer_gettime(int, struct itimerspec *); 47156136Sdavidxuextern int __sys_ktimer_getoverrun(int); 48156136Sdavidxuextern int __sys_ktimer_settime(int, int, 49156136Sdavidxu const struct itimerspec *__restrict, struct itimerspec *__restrict); 50156136Sdavidxu 51156136Sdavidxustruct __timer { 52156136Sdavidxu int oshandle; 53156136Sdavidxu struct sigev_node *node; 54156136Sdavidxu}; 55156136Sdavidxu 56156136Sdavidxu__weak_reference(__timer_create, timer_create); 57156136Sdavidxu__weak_reference(__timer_create, _timer_create); 58156136Sdavidxu__weak_reference(__timer_delete, timer_delete); 59156136Sdavidxu__weak_reference(__timer_delete, _timer_delete); 60156136Sdavidxu__weak_reference(__timer_gettime, timer_gettime); 61156136Sdavidxu__weak_reference(__timer_gettime, _timer_gettime); 62156136Sdavidxu__weak_reference(__timer_settime, timer_settime); 63156136Sdavidxu__weak_reference(__timer_settime, _timer_settime); 64156136Sdavidxu__weak_reference(__timer_getoverrun, timer_getoverrun); 65156136Sdavidxu__weak_reference(__timer_getoverrun, _timer_getoverrun); 66156136Sdavidxu 67156267Sdavidxutypedef void (*timer_func)(union sigval val, int overrun); 68156136Sdavidxu 69156136Sdavidxustatic void 70156267Sdavidxutimer_dispatch(struct sigev_node *sn) 71156136Sdavidxu{ 72156136Sdavidxu timer_func f = sn->sn_func; 73156136Sdavidxu 74156136Sdavidxu /* I want to avoid expired notification. */ 75156267Sdavidxu if (sn->sn_info.si_value.sival_int == sn->sn_gen) 76156267Sdavidxu f(sn->sn_value, sn->sn_info.si_overrun); 77156136Sdavidxu} 78156136Sdavidxu 79156136Sdavidxuint 80156136Sdavidxu__timer_create(clockid_t clockid, struct sigevent *evp, timer_t *timerid) 81156136Sdavidxu{ 82156136Sdavidxu struct __timer *timer; 83156136Sdavidxu struct sigevent ev; 84156136Sdavidxu struct sigev_node *sn; 85156136Sdavidxu int ret, err; 86156136Sdavidxu 87156136Sdavidxu timer = malloc(sizeof(struct __timer)); 88156136Sdavidxu if (timer == NULL) 89156136Sdavidxu return (-1); 90156136Sdavidxu 91156136Sdavidxu if (evp == NULL || evp->sigev_notify != SIGEV_THREAD) { 92156136Sdavidxu ret = __sys_ktimer_create(clockid, evp, &timer->oshandle); 93156136Sdavidxu if (ret == -1) { 94156136Sdavidxu err = errno; 95156136Sdavidxu free(timer); 96156136Sdavidxu errno = err; 97156136Sdavidxu return (ret); 98156136Sdavidxu } 99156136Sdavidxu timer->node = NULL; 100156136Sdavidxu *timerid = timer; 101156136Sdavidxu return (0); 102156136Sdavidxu } 103156136Sdavidxu 104156136Sdavidxu if (__sigev_check_init()) { 105156136Sdavidxu errno = EINVAL; 106156136Sdavidxu return (-1); 107156136Sdavidxu } 108156136Sdavidxu 109156267Sdavidxu sn = __sigev_alloc(SI_TIMER, evp, NULL, 0); 110156136Sdavidxu if (sn == NULL) { 111156136Sdavidxu errno = EAGAIN; 112156136Sdavidxu return (-1); 113156136Sdavidxu } 114156136Sdavidxu 115156136Sdavidxu __sigev_get_sigevent(sn, &ev, sn->sn_gen); 116156136Sdavidxu ret = __sys_ktimer_create(clockid, &ev, &timer->oshandle); 117156136Sdavidxu if (ret != 0) { 118156136Sdavidxu err = errno; 119156136Sdavidxu __sigev_free(sn); 120156136Sdavidxu free(timer); 121156136Sdavidxu errno = err; 122156136Sdavidxu return (-1); 123156136Sdavidxu } 124156414Sdavidxu sn->sn_flags |= SNF_SYNC; 125156136Sdavidxu sn->sn_dispatch = timer_dispatch; 126156136Sdavidxu sn->sn_id = timer->oshandle; 127156265Sdavidxu timer->node = sn; 128156136Sdavidxu __sigev_list_lock(); 129156136Sdavidxu __sigev_register(sn); 130156136Sdavidxu __sigev_list_unlock(); 131156136Sdavidxu *timerid = timer; 132156136Sdavidxu return (0); 133156136Sdavidxu} 134156136Sdavidxu 135156136Sdavidxuint 136156136Sdavidxu__timer_delete(timer_t timerid) 137156136Sdavidxu{ 138156136Sdavidxu int ret, err; 139156136Sdavidxu 140156136Sdavidxu if (timerid->node != NULL) { 141156136Sdavidxu __sigev_list_lock(); 142156136Sdavidxu __sigev_delete_node(timerid->node); 143156136Sdavidxu __sigev_list_unlock(); 144156136Sdavidxu } 145156136Sdavidxu ret = __sys_ktimer_delete(timerid->oshandle); 146156136Sdavidxu err = errno; 147156136Sdavidxu free(timerid); 148156136Sdavidxu errno = err; 149156136Sdavidxu return (ret); 150156136Sdavidxu} 151156136Sdavidxu 152156136Sdavidxuint 153156136Sdavidxu__timer_gettime(timer_t timerid, struct itimerspec *value) 154156136Sdavidxu{ 155156136Sdavidxu 156156136Sdavidxu return __sys_ktimer_gettime(timerid->oshandle, value); 157156136Sdavidxu} 158156136Sdavidxu 159156136Sdavidxuint 160156136Sdavidxu__timer_getoverrun(timer_t timerid) 161156136Sdavidxu{ 162156136Sdavidxu 163156136Sdavidxu return __sys_ktimer_getoverrun(timerid->oshandle); 164156136Sdavidxu} 165156136Sdavidxu 166156136Sdavidxuint 167156136Sdavidxu__timer_settime(timer_t timerid, int flags, 168156136Sdavidxu const struct itimerspec *__restrict value, 169156136Sdavidxu struct itimerspec *__restrict ovalue) 170156136Sdavidxu{ 171156136Sdavidxu 172156136Sdavidxu return __sys_ktimer_settime(timerid->oshandle, 173156136Sdavidxu flags, value, ovalue); 174156136Sdavidxu} 175156136Sdavidxu 176156136Sdavidxuint 177156136Sdavidxu__timer_oshandle(timer_t timerid) 178156136Sdavidxu{ 179156136Sdavidxu 180156136Sdavidxu return (timerid->oshandle); 181156136Sdavidxu} 182