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