pthreads: Partial implementation of final part of robust mutexes: Keep list of all mutexes held by a thread in a list in the TCB.

sched/pthread/Make.defs

@@ -37,7 +37,7 @@ ifneq ($(CONFIG_DISABLE_PTHREAD),y)
 
 CSRCS += pthread_create.c pthread_exit.c pthread_join.c pthread_detach.c
 CSRCS += pthread_yield.c pthread_getschedparam.c pthread_setschedparam.c
-CSRCS += pthread_mutexinit.c pthread_mutexdestroy.c
+CSRCS += pthread_mutexinit.c pthread_mutexdestroy.c pthread_mutex.c
 CSRCS += pthread_mutexlock.c pthread_mutextrylock.c pthread_mutexunlock.c
 CSRCS += pthread_mutexconsistent.c
 CSRCS += pthread_condinit.c pthread_conddestroy.c

sched/pthread/pthread.h

@@ -107,8 +107,10 @@ void pthread_destroyjoin(FAR struct task_group_s *group,
 FAR struct join_s *pthread_findjoininfo(FAR struct task_group_s *group,
                                         pid_t pid);
 void pthread_release(FAR struct task_group_s *group);
-int pthread_givesemaphore(sem_t *sem);
 int pthread_takesemaphore(sem_t *sem, bool intr);
+int pthread_givesemaphore(sem_t *sem);
+int pthread_takemutex(FAR struct pthread_mutex_s *mutex, bool intr);
+int pthread_givemutex(FAR struct pthread_mutex_s *mutex);
 
 #ifdef CONFIG_MUTEX_TYPES
 int pthread_mutexattr_verifytype(int type);

sched/pthread/pthread_condtimedwait.c

@@ -260,7 +260,7 @@ int pthread_cond_timedwait(FAR pthread_cond_t *cond, FAR pthread_mutex_t *mutex,
                   /* Give up the mutex */
 
                   mutex->pid = -1;
-                  ret = pthread_givesemaphore((FAR sem_t *)&mutex->sem);
+                  ret = pthread_givemutex(mutex);
                   if (ret != 0)
                     {
                       /* Restore interrupts  (pre-emption will be enabled when
@@ -316,7 +316,7 @@ int pthread_cond_timedwait(FAR pthread_cond_t *cond, FAR pthread_mutex_t *mutex,
                   /* Reacquire the mutex (retaining the ret). */
 
                   sinfo("Re-locking...\n");
-                  status = pthread_takesemaphore((FAR sem_t *)&mutex->sem, false);
+                  status = pthread_takemutex(mutex, false);
                   if (status == OK)
                     {
                       mutex->pid = mypid;

sched/pthread/pthread_condwait.c

@@ -101,7 +101,7 @@ int pthread_cond_wait(FAR pthread_cond_t *cond, FAR pthread_mutex_t *mutex)
 
       sched_lock();
       mutex->pid = -1;
-      ret = pthread_givesemaphore((FAR sem_t *)&mutex->sem);
+      ret = pthread_givemutex(mutex);
 
       /* Take the semaphore */
 
@@ -122,7 +122,7 @@ int pthread_cond_wait(FAR pthread_cond_t *cond, FAR pthread_mutex_t *mutex)
        */
 
       sinfo("Reacquire mutex...\n");
-      status = pthread_takesemaphore((FAR sem_t *)&mutex->sem, false);
+      status = pthread_takemutex(mutex, false);
       if (ret == OK)
         {
           /* Report the first failure that occurs */

sched/pthread/pthread_mutexlock.c

@@ -133,8 +133,15 @@ int pthread_mutex_lock(FAR pthread_mutex_t *mutex)
                * success.
                */
 
-              mutex->nlocks++;
-              ret = OK;
+              if (mutex->nlocks < INT16_MAX)
+                {
+                  mutex->nlocks++;
+                  ret = OK;
+                }
+              else
+                {
+                  ret = EOVERFLOW;
+                }
             }
           else
 #endif
@@ -176,7 +183,7 @@ int pthread_mutex_lock(FAR pthread_mutex_t *mutex)
         {
           /* Take the underlying semaphore, waiting if necessary */
 
-          ret = pthread_takesemaphore((FAR sem_t *)&mutex->sem, true);
+          ret = pthread_takemutex(mutex, true);
 
           /* If we successfully obtained the semaphore, then indicate
            * that we own it.
@@ -189,14 +196,6 @@ int pthread_mutex_lock(FAR pthread_mutex_t *mutex)
               mutex->nlocks = 1;
 #endif
             }
-
-          /* Check if we were awakened by a signal.  This might happen if the
-           * tasking holding the mutex just exitted.
-           */
-
-         else if (ret == EINTR)
-           {
-           }
         }
 
       sched_unlock();

sched/pthread/pthread_mutextrylock.c

@@ -136,8 +136,15 @@ int pthread_mutex_trylock(FAR pthread_mutex_t *mutex)
                 {
                   /* Increment the number of locks held and return successfully. */
 
-                  mutex->nlocks++;
-                  ret = OK;
+                  if (mutex->nlocks < INT16_MAX)
+                    {
+                      mutex->nlocks++;
+                      ret = OK;
+                    }
+                  else
+                    {
+                      ret = EOVERFLOW;
+                    }
                 }
               else
 #endif

sched/pthread/pthread_mutexunlock.c

@@ -139,7 +139,7 @@ int pthread_mutex_unlock(FAR pthread_mutex_t *mutex)
 #ifdef CONFIG_MUTEX_TYPES
           mutex->nlocks = 0;
 #endif
-          ret = pthread_givesemaphore((FAR sem_t *)&mutex->sem);
+          ret = pthread_givemutex(mutex);
         }
 
       sched_unlock();