timer.c revision 156267
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 156267 2006-03-04 00:18:19Z 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 <pthread.h> 37156136Sdavidxu#include <stddef.h> 38156136Sdavidxu#include <signal.h> 39156136Sdavidxu#include <stdlib.h> 40156136Sdavidxu#include <time.h> 41156136Sdavidxu#include <unistd.h> 42156136Sdavidxu#include "sigev_thread.h" 43156136Sdavidxu#include "un-namespace.h" 44156136Sdavidxu 45156136Sdavidxuextern int __sys_ktimer_create(clockid_t, struct sigevent *__restrict, 46156136Sdavidxu int *__restrict); 47156136Sdavidxuextern int __sys_ktimer_delete(int); 48156136Sdavidxuextern int __sys_ktimer_gettime(int, struct itimerspec *); 49156136Sdavidxuextern int __sys_ktimer_getoverrun(int); 50156136Sdavidxuextern int __sys_ktimer_settime(int, int, 51156136Sdavidxu const struct itimerspec *__restrict, struct itimerspec *__restrict); 52156136Sdavidxu 53156136Sdavidxustruct __timer { 54156136Sdavidxu int oshandle; 55156136Sdavidxu struct sigev_node *node; 56156136Sdavidxu}; 57156136Sdavidxu 58156136Sdavidxu__weak_reference(__timer_create, timer_create); 59156136Sdavidxu__weak_reference(__timer_create, _timer_create); 60156136Sdavidxu__weak_reference(__timer_delete, timer_delete); 61156136Sdavidxu__weak_reference(__timer_delete, _timer_delete); 62156136Sdavidxu__weak_reference(__timer_gettime, timer_gettime); 63156136Sdavidxu__weak_reference(__timer_gettime, _timer_gettime); 64156136Sdavidxu__weak_reference(__timer_settime, timer_settime); 65156136Sdavidxu__weak_reference(__timer_settime, _timer_settime); 66156136Sdavidxu__weak_reference(__timer_getoverrun, timer_getoverrun); 67156136Sdavidxu__weak_reference(__timer_getoverrun, _timer_getoverrun); 68156136Sdavidxu 69156267Sdavidxutypedef void (*timer_func)(union sigval val, int overrun); 70156136Sdavidxu 71156136Sdavidxustatic void 72156267Sdavidxutimer_dispatch(struct sigev_node *sn) 73156136Sdavidxu{ 74156136Sdavidxu timer_func f = sn->sn_func; 75156136Sdavidxu 76156136Sdavidxu /* I want to avoid expired notification. */ 77156267Sdavidxu if (sn->sn_info.si_value.sival_int == sn->sn_gen) 78156267Sdavidxu f(sn->sn_value, sn->sn_info.si_overrun); 79156136Sdavidxu} 80156136Sdavidxu 81156136Sdavidxuint 82156136Sdavidxu__timer_create(clockid_t clockid, struct sigevent *evp, timer_t *timerid) 83156136Sdavidxu{ 84156136Sdavidxu struct __timer *timer; 85156136Sdavidxu struct sigevent ev; 86156136Sdavidxu struct sigev_node *sn; 87156136Sdavidxu int ret, err; 88156136Sdavidxu 89156136Sdavidxu timer = malloc(sizeof(struct __timer)); 90156136Sdavidxu if (timer == NULL) 91156136Sdavidxu return (-1); 92156136Sdavidxu 93156136Sdavidxu if (evp == NULL || evp->sigev_notify != SIGEV_THREAD) { 94156136Sdavidxu ret = __sys_ktimer_create(clockid, evp, &timer->oshandle); 95156136Sdavidxu if (ret == -1) { 96156136Sdavidxu err = errno; 97156136Sdavidxu free(timer); 98156136Sdavidxu errno = err; 99156136Sdavidxu return (ret); 100156136Sdavidxu } 101156136Sdavidxu timer->node = NULL; 102156136Sdavidxu *timerid = timer; 103156136Sdavidxu return (0); 104156136Sdavidxu } 105156136Sdavidxu 106156136Sdavidxu if (__sigev_check_init()) { 107156136Sdavidxu errno = EINVAL; 108156136Sdavidxu return (-1); 109156136Sdavidxu } 110156136Sdavidxu 111156267Sdavidxu sn = __sigev_alloc(SI_TIMER, evp, NULL, 0); 112156136Sdavidxu if (sn == NULL) { 113156136Sdavidxu errno = EAGAIN; 114156136Sdavidxu return (-1); 115156136Sdavidxu } 116156136Sdavidxu 117156136Sdavidxu __sigev_get_sigevent(sn, &ev, sn->sn_gen); 118156136Sdavidxu ret = __sys_ktimer_create(clockid, &ev, &timer->oshandle); 119156136Sdavidxu if (ret != 0) { 120156136Sdavidxu err = errno; 121156136Sdavidxu __sigev_free(sn); 122156136Sdavidxu free(timer); 123156136Sdavidxu errno = err; 124156136Sdavidxu return (-1); 125156136Sdavidxu } 126156136Sdavidxu sn->sn_dispatch = timer_dispatch; 127156136Sdavidxu sn->sn_id = timer->oshandle; 128156265Sdavidxu timer->node = sn; 129156136Sdavidxu __sigev_list_lock(); 130156136Sdavidxu __sigev_register(sn); 131156136Sdavidxu __sigev_list_unlock(); 132156136Sdavidxu *timerid = timer; 133156136Sdavidxu return (0); 134156136Sdavidxu} 135156136Sdavidxu 136156136Sdavidxuint 137156136Sdavidxu__timer_delete(timer_t timerid) 138156136Sdavidxu{ 139156136Sdavidxu int ret, err; 140156136Sdavidxu 141156136Sdavidxu if (timerid->node != NULL) { 142156136Sdavidxu __sigev_list_lock(); 143156136Sdavidxu __sigev_delete_node(timerid->node); 144156136Sdavidxu __sigev_list_unlock(); 145156136Sdavidxu } 146156136Sdavidxu ret = __sys_ktimer_delete(timerid->oshandle); 147156136Sdavidxu err = errno; 148156136Sdavidxu free(timerid); 149156136Sdavidxu errno = err; 150156136Sdavidxu return (ret); 151156136Sdavidxu} 152156136Sdavidxu 153156136Sdavidxuint 154156136Sdavidxu__timer_gettime(timer_t timerid, struct itimerspec *value) 155156136Sdavidxu{ 156156136Sdavidxu 157156136Sdavidxu return __sys_ktimer_gettime(timerid->oshandle, value); 158156136Sdavidxu} 159156136Sdavidxu 160156136Sdavidxuint 161156136Sdavidxu__timer_getoverrun(timer_t timerid) 162156136Sdavidxu{ 163156136Sdavidxu 164156136Sdavidxu return __sys_ktimer_getoverrun(timerid->oshandle); 165156136Sdavidxu} 166156136Sdavidxu 167156136Sdavidxuint 168156136Sdavidxu__timer_settime(timer_t timerid, int flags, 169156136Sdavidxu const struct itimerspec *__restrict value, 170156136Sdavidxu struct itimerspec *__restrict ovalue) 171156136Sdavidxu{ 172156136Sdavidxu 173156136Sdavidxu return __sys_ktimer_settime(timerid->oshandle, 174156136Sdavidxu flags, value, ovalue); 175156136Sdavidxu} 176156136Sdavidxu 177156136Sdavidxuint 178156136Sdavidxu__timer_oshandle(timer_t timerid) 179156136Sdavidxu{ 180156136Sdavidxu 181156136Sdavidxu return (timerid->oshandle); 182156136Sdavidxu} 183