1#include <pthread.h>
2#include <time.h>
3#include <errno.h>
4#include "futex.h"
5#include "syscall.h"
6#include "pthread_impl.h"
7
8int __pthread_setcancelstate(int, int *);
9int __clock_gettime(clockid_t, struct timespec *);
10
11int __timedwait_cp(volatile int *addr, int val,
12	clockid_t clk, const struct timespec *at, int priv)
13{
14	int r;
15	struct timespec to, *top=0;
16
17	if (priv) priv = 128;
18
19	if (at) {
20		if (at->tv_nsec >= 1000000000UL) return EINVAL;
21		if (__clock_gettime(clk, &to)) return EINVAL;
22		to.tv_sec = at->tv_sec - to.tv_sec;
23		if ((to.tv_nsec = at->tv_nsec - to.tv_nsec) < 0) {
24			to.tv_sec--;
25			to.tv_nsec += 1000000000;
26		}
27		if (to.tv_sec < 0) return ETIMEDOUT;
28		top = &to;
29	}
30
31	r = -__syscall_cp(SYS_futex, addr, FUTEX_WAIT|priv, val, top);
32	if (r == ENOSYS) r = -__syscall_cp(SYS_futex, addr, FUTEX_WAIT, val, top);
33	if (r != EINTR && r != ETIMEDOUT && r != ECANCELED) r = 0;
34
35	return r;
36}
37
38int __timedwait(volatile int *addr, int val,
39	clockid_t clk, const struct timespec *at, int priv)
40{
41	int cs, r;
42	__pthread_setcancelstate(PTHREAD_CANCEL_DISABLE, &cs);
43	r = __timedwait_cp(addr, val, clk, at, priv);
44	__pthread_setcancelstate(cs, 0);
45	return r;
46}
47