X-Git-Url: http://nsz.repo.hu/git/?a=blobdiff_plain;f=src%2Fthread%2Fsem_timedwait.c;h=db05b417ca3703c58cea5a5c64148f004b569720;hb=7779dbd2663269b465951189b4f43e70839bc073;hp=ad3bf07581e2a83f01bfcd495b3f244c82ecdbe0;hpb=cfe581b6bc795e3f00ac30791314ec0f9be4b4ad;p=musl

diff --git a/src/thread/sem_timedwait.c b/src/thread/sem_timedwait.c
index ad3bf075..db05b417 100644
--- a/src/thread/sem_timedwait.c
+++ b/src/thread/sem_timedwait.c
@@ -1,23 +1,38 @@
 #include <semaphore.h>
 #include "pthread_impl.h"
 
+static void cleanup(void *p)
+{
+	a_dec(p);
+}
+
 int sem_timedwait(sem_t *sem, const struct timespec *at)
 {
-	int val;
+	int r;
+
+	if (a_fetch_add(sem->__val, -1) > 0) return 0;
+	a_inc(sem->__val);
+
+	if (at && at->tv_nsec >= 1000000000UL) {
+		errno = EINVAL;
+		return -1;
+	}
+
+	a_inc(sem->__val+1);
+	pthread_cleanup_push(cleanup, sem->__val+1)
 
 	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);
-		CANCELPT_BEGIN;
-		if (at && at->tv_nsec >= 1000000000UL) {
-			errno = EINVAL;
-			return -1;
-		}
-		if (val <= 0 && __timedwait(sem->__val, val, CLOCK_REALTIME, at, 0) == ETIMEDOUT) {
-			errno = ETIMEDOUT;
-			return -1;
+		r = 0;
+		if (!sem_trywait(sem)) break;
+		r = __timedwait_cp(sem->__val, 0, CLOCK_REALTIME, at, 0);
+		if (r) {
+			errno = r;
+			r = -1;
+			break;
 		}
-		CANCELPT_END;
 	}
+
+	pthread_cleanup_pop(1);
+
+	return r;
 }