summaryrefslogtreecommitdiff
path: root/src/thread/sem_timedwait.c
blob: 11a017005fc09df08502833431506b2f4e51795f (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
#include <semaphore.h>
#include "pthread_impl.h"

int sem_timedwait(sem_t *sem, const struct timespec *at)
{
	int val;

	for (;;) {
		if (a_fetch_add(sem->__val, -1) > 0) return 0;
		val = a_fetch_add(sem->__val, 1)+1;
		if (val==1) __wake(sem->__val, 1, 0);
		if (at && at->tv_nsec >= 1000000000UL) {
			errno = EINVAL;
			return -1;
		}
		CANCELPT_BEGIN;
		if (val <= 0 && __timedwait(sem->__val, val, CLOCK_REALTIME, at, 0) == ETIMEDOUT) {
			errno = ETIMEDOUT;
			CANCELPT_TRY;
			CANCELPT_END;
			return -1;
		}
		CANCELPT_TRY;
		CANCELPT_END;
	}
}