Adjust use of lll_futex_* macros.
[kopensolaris-gnu/glibc.git] / nptl / sysdeps / unix / sysv / linux / lowlevelrobustlock.c
1 /* Copyright (C) 2006, 2007 Free Software Foundation, Inc.
2    This file is part of the GNU C Library.
3    Contributed by Jakub Jelinek <jakub@redhat.com>, 2006.
4
5    The GNU C Library is free software; you can redistribute it and/or
6    modify it under the terms of the GNU Lesser General Public
7    License as published by the Free Software Foundation; either
8    version 2.1 of the License, or (at your option) any later version.
9
10    The GNU C Library is distributed in the hope that it will be useful,
11    but WITHOUT ANY WARRANTY; without even the implied warranty of
12    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
13    Lesser General Public License for more details.
14
15    You should have received a copy of the GNU Lesser General Public
16    License along with the GNU C Library; if not, write to the Free
17    Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
18    02111-1307 USA.  */
19
20 #include <errno.h>
21 #include <sysdep.h>
22 #include <lowlevellock.h>
23 #include <sys/time.h>
24 #include <pthreadP.h>
25
26
27 int
28 __lll_robust_lock_wait (int *futex)
29 {
30   int oldval = *futex;
31   int tid = THREAD_GETMEM (THREAD_SELF, tid);
32
33   /* If the futex changed meanwhile try locking again.  */
34   if (oldval == 0)
35     goto try;
36
37   do
38     {
39       if (__builtin_expect (oldval & FUTEX_OWNER_DIED, 0))
40         return oldval;
41
42       int newval = oldval | FUTEX_WAITERS;
43       if (oldval != newval
44           && atomic_compare_and_exchange_bool_acq (futex, newval, oldval))
45         continue;
46
47       lll_futex_wait (futex, newval,
48                       // XYZ check mutex flag
49                       LLL_SHARED);
50
51     try:
52       ;
53     }
54   while ((oldval = atomic_compare_and_exchange_val_acq (futex,
55                                                         tid | FUTEX_WAITERS,
56                                                         0)) != 0);
57   return 0;
58 }
59
60
61 int
62 __lll_robust_timedlock_wait (int *futex, const struct timespec *abstime)
63 {
64   /* Reject invalid timeouts.  */
65   if (abstime->tv_nsec < 0 || abstime->tv_nsec >= 1000000000)
66     return EINVAL;
67
68   int tid = THREAD_GETMEM (THREAD_SELF, tid);
69   int oldval = *futex;
70
71   /* If the futex changed meanwhile try locking again.  */
72   if (oldval == 0)
73     goto try;
74
75   do
76     {
77       struct timeval tv;
78       struct timespec rt;
79
80       /* Get the current time.  */
81       (void) __gettimeofday (&tv, NULL);
82
83       /* Compute relative timeout.  */
84       rt.tv_sec = abstime->tv_sec - tv.tv_sec;
85       rt.tv_nsec = abstime->tv_nsec - tv.tv_usec * 1000;
86       if (rt.tv_nsec < 0)
87         {
88           rt.tv_nsec += 1000000000;
89           --rt.tv_sec;
90         }
91
92       /* Already timed out?  */
93       if (rt.tv_sec < 0)
94         return ETIMEDOUT;
95
96       /* Wait.  */
97       if (__builtin_expect (oldval & FUTEX_OWNER_DIED, 0))
98         return oldval;
99
100       int newval = oldval | FUTEX_WAITERS;
101       if (oldval != newval
102           && atomic_compare_and_exchange_bool_acq (futex, newval, oldval))
103         continue;
104
105       lll_futex_timed_wait (futex, newval, &rt,
106                             // XYZ check mutex flag
107                             LLL_SHARED);
108
109     try:
110       ;
111     }
112   while ((oldval = atomic_compare_and_exchange_val_acq (futex,
113                                                         tid | FUTEX_WAITERS,
114                                                         0)) != 0);
115
116   return 0;
117 }