Update s390 libm-test-ulps
[platform/upstream/glibc.git] / nptl / pthread_mutex_timedlock.c
index dcff4f8..b7f34d4 100644 (file)
@@ -1,4 +1,4 @@
-/* Copyright (C) 2002, 2003, 2004, 2005, 2006 Free Software Foundation, Inc.
+/* Copyright (C) 2002-2007, 2008 Free Software Foundation, Inc.
    This file is part of the GNU C Library.
    Contributed by Ulrich Drepper <drepper@redhat.com>, 2002.
 
@@ -13,9 +13,8 @@
    Lesser General Public License for more details.
 
    You should have received a copy of the GNU Lesser General Public
-   License along with the GNU C Library; if not, write to the Free
-   Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA
-   02111-1307 USA.  */
+   License along with the GNU C Library; if not, see
+   <http://www.gnu.org/licenses/>.  */
 
 #include <assert.h>
 #include <errno.h>
@@ -37,7 +36,8 @@ pthread_mutex_timedlock (mutex, abstime)
   /* We must not check ABSTIME here.  If the thread does not block
      abstime must not be checked for a valid value.  */
 
-  switch (__builtin_expect (mutex->__data.__kind, PTHREAD_MUTEX_TIMED_NP))
+  switch (__builtin_expect (PTHREAD_MUTEX_TYPE (mutex),
+                           PTHREAD_MUTEX_TIMED_NP))
     {
       /* Recursive mutex.  */
     case PTHREAD_MUTEX_RECURSIVE_NP:
@@ -55,7 +55,8 @@ pthread_mutex_timedlock (mutex, abstime)
        }
 
       /* We have to get the mutex.  */
-      result = lll_mutex_timedlock (mutex->__data.__lock, abstime);
+      result = lll_timedlock (mutex->__data.__lock, abstime,
+                             PTHREAD_MUTEX_PSHARED (mutex));
 
       if (result != 0)
        goto out;
@@ -75,14 +76,15 @@ pthread_mutex_timedlock (mutex, abstime)
     case PTHREAD_MUTEX_TIMED_NP:
     simple:
       /* Normal mutex.  */
-      result = lll_mutex_timedlock (mutex->__data.__lock, abstime);
+      result = lll_timedlock (mutex->__data.__lock, abstime,
+                             PTHREAD_MUTEX_PSHARED (mutex));
       break;
 
     case PTHREAD_MUTEX_ADAPTIVE_NP:
       if (! __is_smp)
        goto simple;
 
-      if (lll_mutex_trylock (mutex->__data.__lock) != 0)
+      if (lll_trylock (mutex->__data.__lock) != 0)
        {
          int cnt = 0;
          int max_cnt = MIN (MAX_ADAPTIVE_COUNT,
@@ -91,7 +93,8 @@ pthread_mutex_timedlock (mutex, abstime)
            {
              if (cnt++ >= max_cnt)
                {
-                 result = lll_mutex_timedlock (mutex->__data.__lock, abstime);
+                 result = lll_timedlock (mutex->__data.__lock, abstime,
+                                         PTHREAD_MUTEX_PSHARED (mutex));
                  break;
                }
 
@@ -99,7 +102,7 @@ pthread_mutex_timedlock (mutex, abstime)
              BUSY_WAIT_NOP;
 #endif
            }
-         while (lll_mutex_trylock (mutex->__data.__lock) != 0);
+         while (lll_trylock (mutex->__data.__lock) != 0);
 
          mutex->__data.__spins += (cnt - mutex->__data.__spins) / 8;
        }
@@ -119,9 +122,11 @@ pthread_mutex_timedlock (mutex, abstime)
          if ((oldval & FUTEX_OWNER_DIED) != 0)
            {
              /* The previous owner died.  Try locking the mutex.  */
-             int newval
+             int newval = id | (oldval & FUTEX_WAITERS);
+
+             newval
                = atomic_compare_and_exchange_val_acq (&mutex->__data.__lock,
-                                                      id, oldval);
+                                                      newval, oldval);
              if (newval != oldval)
                {
                  oldval = newval;
@@ -146,16 +151,15 @@ pthread_mutex_timedlock (mutex, abstime)
          /* Check whether we already hold the mutex.  */
          if (__builtin_expect ((oldval & FUTEX_TID_MASK) == id, 0))
            {
-             if (mutex->__data.__kind
-                 == PTHREAD_MUTEX_ROBUST_ERRORCHECK_NP)
+             int kind = PTHREAD_MUTEX_TYPE (mutex);
+             if (kind == PTHREAD_MUTEX_ROBUST_ERRORCHECK_NP)
                {
                  THREAD_SETMEM (THREAD_SELF, robust_head.list_op_pending,
                                 NULL);
                  return EDEADLK;
                }
 
-             if (mutex->__data.__kind
-                 == PTHREAD_MUTEX_ROBUST_RECURSIVE_NP)
+             if (kind == PTHREAD_MUTEX_ROBUST_RECURSIVE_NP)
                {
                  THREAD_SETMEM (THREAD_SELF, robust_head.list_op_pending,
                                 NULL);
@@ -171,15 +175,16 @@ pthread_mutex_timedlock (mutex, abstime)
                }
            }
 
-         result = lll_robust_mutex_timedlock (mutex->__data.__lock, abstime,
-                                              id);
+         result = lll_robust_timedlock (mutex->__data.__lock, abstime, id,
+                                        PTHREAD_ROBUST_MUTEX_PSHARED (mutex));
 
          if (__builtin_expect (mutex->__data.__owner
                                == PTHREAD_MUTEX_NOTRECOVERABLE, 0))
            {
              /* This mutex is now not recoverable.  */
              mutex->__data.__count = 0;
-             lll_mutex_unlock (mutex->__data.__lock);
+             lll_unlock (mutex->__data.__lock,
+                         PTHREAD_ROBUST_MUTEX_PSHARED (mutex));
              THREAD_SETMEM (THREAD_SELF, robust_head.list_op_pending, NULL);
              return ENOTRECOVERABLE;
            }
@@ -248,10 +253,15 @@ pthread_mutex_timedlock (mutex, abstime)
            /* The mutex is locked.  The kernel will now take care of
               everything.  The timeout value must be a relative value.
               Convert it.  */
+           int private = (robust
+                          ? PTHREAD_ROBUST_MUTEX_PSHARED (mutex)
+                          : PTHREAD_MUTEX_PSHARED (mutex));
            INTERNAL_SYSCALL_DECL (__err);
 
            int e = INTERNAL_SYSCALL (futex, __err, 4, &mutex->__data.__lock,
-                                     FUTEX_LOCK_PI, 1, abstime);
+                                     __lll_private_flag (FUTEX_LOCK_PI,
+                                                         private), 1,
+                                     abstime);
            if (INTERNAL_SYSCALL_ERROR_P (e, __err))
              {
                if (INTERNAL_SYSCALL_ERRNO (e, __err) == ETIMEDOUT)
@@ -325,7 +335,9 @@ pthread_mutex_timedlock (mutex, abstime)
 
            INTERNAL_SYSCALL_DECL (__err);
            INTERNAL_SYSCALL (futex, __err, 4, &mutex->__data.__lock,
-                             FUTEX_UNLOCK_PI, 0, 0);
+                             __lll_private_flag (FUTEX_UNLOCK_PI,
+                                                 PTHREAD_ROBUST_MUTEX_PSHARED (mutex)),
+                             0, 0);
 
            THREAD_SETMEM (THREAD_SELF, robust_head.list_op_pending, NULL);
            return ENOTRECOVERABLE;
@@ -340,6 +352,120 @@ pthread_mutex_timedlock (mutex, abstime)
        }
       break;
 
+    case PTHREAD_MUTEX_PP_RECURSIVE_NP:
+    case PTHREAD_MUTEX_PP_ERRORCHECK_NP:
+    case PTHREAD_MUTEX_PP_NORMAL_NP:
+    case PTHREAD_MUTEX_PP_ADAPTIVE_NP:
+      {
+       int kind = mutex->__data.__kind & PTHREAD_MUTEX_KIND_MASK_NP;
+
+       oldval = mutex->__data.__lock;
+
+       /* Check whether we already hold the mutex.  */
+       if (mutex->__data.__owner == id)
+         {
+           if (kind == PTHREAD_MUTEX_ERRORCHECK_NP)
+             return EDEADLK;
+
+           if (kind == PTHREAD_MUTEX_RECURSIVE_NP)
+             {
+               /* Just bump the counter.  */
+               if (__builtin_expect (mutex->__data.__count + 1 == 0, 0))
+                 /* Overflow of the counter.  */
+                 return EAGAIN;
+
+               ++mutex->__data.__count;
+
+               return 0;
+             }
+         }
+
+       int oldprio = -1, ceilval;
+       do
+         {
+           int ceiling = (oldval & PTHREAD_MUTEX_PRIO_CEILING_MASK)
+                         >> PTHREAD_MUTEX_PRIO_CEILING_SHIFT;
+
+           if (__pthread_current_priority () > ceiling)
+             {
+               result = EINVAL;
+             failpp:
+               if (oldprio != -1)
+                 __pthread_tpp_change_priority (oldprio, -1);
+               return result;
+             }
+
+           result = __pthread_tpp_change_priority (oldprio, ceiling);
+           if (result)
+             return result;
+
+           ceilval = ceiling << PTHREAD_MUTEX_PRIO_CEILING_SHIFT;
+           oldprio = ceiling;
+
+           oldval
+             = atomic_compare_and_exchange_val_acq (&mutex->__data.__lock,
+                                                    ceilval | 1, ceilval);
+
+           if (oldval == ceilval)
+             break;
+
+           do
+             {
+               oldval
+                 = atomic_compare_and_exchange_val_acq (&mutex->__data.__lock,
+                                                        ceilval | 2,
+                                                        ceilval | 1);
+
+               if ((oldval & PTHREAD_MUTEX_PRIO_CEILING_MASK) != ceilval)
+                 break;
+
+               if (oldval != ceilval)
+                 {
+                   /* Reject invalid timeouts.  */
+                   if (abstime->tv_nsec < 0 || abstime->tv_nsec >= 1000000000)
+                     {
+                       result = EINVAL;
+                       goto failpp;
+                     }
+
+                   struct timeval tv;
+                   struct timespec rt;
+
+                   /* Get the current time.  */
+                   (void) __gettimeofday (&tv, NULL);
+
+                   /* Compute relative timeout.  */
+                   rt.tv_sec = abstime->tv_sec - tv.tv_sec;
+                   rt.tv_nsec = abstime->tv_nsec - tv.tv_usec * 1000;
+                   if (rt.tv_nsec < 0)
+                     {
+                       rt.tv_nsec += 1000000000;
+                       --rt.tv_sec;
+                     }
+
+                   /* Already timed out?  */
+                   if (rt.tv_sec < 0)
+                     {
+                       result = ETIMEDOUT;
+                       goto failpp;
+                     }
+
+                   lll_futex_timed_wait (&mutex->__data.__lock,
+                                         ceilval | 2, &rt,
+                                         PTHREAD_MUTEX_PSHARED (mutex));
+                 }
+             }
+           while (atomic_compare_and_exchange_val_acq (&mutex->__data.__lock,
+                                                       ceilval | 2, ceilval)
+                  != ceilval);
+         }
+       while ((oldval & PTHREAD_MUTEX_PRIO_CEILING_MASK) != ceilval);
+
+       assert (mutex->__data.__owner == 0);
+       mutex->__data.__count = 1;
+      }
+      break;
+
     default:
       /* Correct code cannot set any other type.  */
       return EINVAL;