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$ 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()) { 105227661Skib free(timer); 106156136Sdavidxu errno = EINVAL; 107156136Sdavidxu return (-1); 108156136Sdavidxu } 109156136Sdavidxu 110156267Sdavidxu sn = __sigev_alloc(SI_TIMER, evp, NULL, 0); 111156136Sdavidxu if (sn == NULL) { 112227661Skib free(timer); 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 } 126156414Sdavidxu sn->sn_flags |= SNF_SYNC; 127156136Sdavidxu sn->sn_dispatch = timer_dispatch; 128156136Sdavidxu sn->sn_id = timer->oshandle; 129156265Sdavidxu timer->node = sn; 130156136Sdavidxu __sigev_list_lock(); 131156136Sdavidxu __sigev_register(sn); 132156136Sdavidxu __sigev_list_unlock(); 133156136Sdavidxu *timerid = timer; 134156136Sdavidxu return (0); 135156136Sdavidxu} 136156136Sdavidxu 137156136Sdavidxuint 138156136Sdavidxu__timer_delete(timer_t timerid) 139156136Sdavidxu{ 140156136Sdavidxu int ret, err; 141156136Sdavidxu 142156136Sdavidxu if (timerid->node != NULL) { 143156136Sdavidxu __sigev_list_lock(); 144156136Sdavidxu __sigev_delete_node(timerid->node); 145156136Sdavidxu __sigev_list_unlock(); 146156136Sdavidxu } 147156136Sdavidxu ret = __sys_ktimer_delete(timerid->oshandle); 148156136Sdavidxu err = errno; 149156136Sdavidxu free(timerid); 150156136Sdavidxu errno = err; 151156136Sdavidxu return (ret); 152156136Sdavidxu} 153156136Sdavidxu 154156136Sdavidxuint 155156136Sdavidxu__timer_gettime(timer_t timerid, struct itimerspec *value) 156156136Sdavidxu{ 157156136Sdavidxu 158156136Sdavidxu return __sys_ktimer_gettime(timerid->oshandle, value); 159156136Sdavidxu} 160156136Sdavidxu 161156136Sdavidxuint 162156136Sdavidxu__timer_getoverrun(timer_t timerid) 163156136Sdavidxu{ 164156136Sdavidxu 165156136Sdavidxu return __sys_ktimer_getoverrun(timerid->oshandle); 166156136Sdavidxu} 167156136Sdavidxu 168156136Sdavidxuint 169156136Sdavidxu__timer_settime(timer_t timerid, int flags, 170156136Sdavidxu const struct itimerspec *__restrict value, 171156136Sdavidxu struct itimerspec *__restrict ovalue) 172156136Sdavidxu{ 173156136Sdavidxu 174156136Sdavidxu return __sys_ktimer_settime(timerid->oshandle, 175156136Sdavidxu flags, value, ovalue); 176156136Sdavidxu} 177156136Sdavidxu 178156136Sdavidxuint 179156136Sdavidxu__timer_oshandle(timer_t timerid) 180156136Sdavidxu{ 181156136Sdavidxu 182156136Sdavidxu return (timerid->oshandle); 183156136Sdavidxu} 184