- 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)
-
- CANCELPT_BEGIN;
- for (;;) {
- r = 0;
- if (!sem_trywait(sem)) break;
- r = __timedwait(sem->__val, 0, CLOCK_REALTIME, at, 0);
+ while (sem_trywait(sem)) {
+ int r;
+ a_inc(sem->__val+1);
+ a_cas(sem->__val, 0, -1);
+ r = __timedwait(sem->__val, -1, CLOCK_REALTIME, at, cleanup, sem->__val+1, 0);
+ a_dec(sem->__val+1);