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
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
|
/* Wait on a semaphore with a timeout. Generic version.
Copyright (C) 2005, 2006, 2008 Free Software Foundation, Inc.
This file is part of the GNU C Library.
The GNU C Library is free software; you can redistribute it and/or
modify it under the terms of the GNU Library General Public License as
published by the Free Software Foundation; either version 2 of the
License, or (at your option) any later version.
The GNU C Library is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
Library General Public License for more details.
You should have received a copy of the GNU Library General Public
License along with the GNU C Library; see the file COPYING.LIB. If not,
write to the Free Software Foundation, Inc., 59 Temple Place - Suite 330,
Boston, MA 02111-1307, USA. */
#include <semaphore.h>
#include <errno.h>
#include <assert.h>
#include <pt-internal.h>
int
__sem_timedwait_internal (sem_t *restrict sem,
const struct timespec *restrict timeout)
{
error_t err;
int drain;
struct __pthread *self;
__pthread_spin_lock (&sem->__lock);
if (sem->__value > 0)
/* Successful down. */
{
sem->__value --;
__pthread_spin_unlock (&sem->__lock);
return 0;
}
if (timeout && (timeout->tv_nsec < 0 || timeout->tv_nsec >= 1000000000))
{
errno = EINVAL;
return -1;
}
/* Add ourselves to the queue. */
self = _pthread_self ();
__pthread_enqueue (&sem->__queue, self);
__pthread_spin_unlock (&sem->__lock);
/* Block the thread. */
if (timeout)
err = __pthread_timedblock (self, timeout, CLOCK_REALTIME);
else
{
err = 0;
__pthread_block (self);
}
__pthread_spin_lock (&sem->__lock);
if (! self->prevp)
/* Another thread removed us from the queue, which means a wakeup message
has been sent. It was either consumed while we were blocking, or
queued after we timed out and before we acquired the semaphore lock, in
which case the message queue must be drained. */
drain = err ? 1 : 0;
else
{
/* We're still in the queue. Noone attempted to wake us up, i.e. we
timed out. */
__pthread_dequeue (self);
drain = 0;
}
__pthread_spin_unlock (&sem->__lock);
if (drain)
__pthread_block (self);
if (err)
{
assert (err == ETIMEDOUT);
errno = err;
return -1;
}
return 0;
}
int
__sem_timedwait (sem_t *restrict sem,
const struct timespec *restrict timeout)
{
return __sem_timedwait_internal (sem, timeout);
}
strong_alias (__sem_timedwait, sem_timedwait);
|
