#include "pthread_internals.h"
int
pthread_mutex_destroy(pthread_mutex_t *mutex)
{
int res;
LOCK(mutex->lock);
if (mutex->sig == _PTHREAD_MUTEX_SIG)
{
if (mutex->owner == (pthread_t)NULL &&
mutex->busy == (pthread_cond_t *)NULL)
{
mutex->sig = _PTHREAD_NO_SIG;
res = ESUCCESS;
}
else
res = EBUSY;
}
else
res = EINVAL;
UNLOCK(mutex->lock);
return (res);
}
static int
_pthread_mutex_init(pthread_mutex_t *mutex, const pthread_mutexattr_t *attr)
{
if (attr)
{
if (attr->sig != _PTHREAD_MUTEX_ATTR_SIG)
return (EINVAL);
mutex->prioceiling = attr->prioceiling;
mutex->protocol = attr->protocol;
mutex->type = attr->type;
} else {
mutex->prioceiling = _PTHREAD_DEFAULT_PRIOCEILING;
mutex->protocol = _PTHREAD_DEFAULT_PROTOCOL;
mutex->type = PTHREAD_MUTEX_DEFAULT;
}
mutex->lock_count = 0;
mutex->owner = (pthread_t)NULL;
mutex->next = (pthread_mutex_t *)NULL;
mutex->prev = (pthread_mutex_t *)NULL;
mutex->busy = (pthread_cond_t *)NULL;
mutex->waiters = 0;
mutex->sem = SEMAPHORE_NULL;
mutex->order = SEMAPHORE_NULL;
mutex->sig = _PTHREAD_MUTEX_SIG;
return (ESUCCESS);
}
int
pthread_mutex_init(pthread_mutex_t *mutex, const pthread_mutexattr_t *attr)
{
LOCK_INIT(mutex->lock);
return (_pthread_mutex_init(mutex, attr));
}
#if defined(DEBUG)
static void
_pthread_mutex_add(pthread_mutex_t *mutex, pthread_t self)
{
pthread_mutex_t *m;
if (self != (pthread_t)0)
{
if ((m = self->mutexes) != (pthread_mutex_t *)NULL)
{
m->prev = mutex;
}
mutex->next = m;
mutex->prev = (pthread_mutex_t *)NULL;
self->mutexes = mutex;
}
}
__private_extern__ void
_pthread_mutex_remove(pthread_mutex_t *mutex, pthread_t self)
{
pthread_mutex_t *n, *prev;
if ((n = mutex->next) != (pthread_mutex_t *)NULL)
{
n->prev = mutex->prev;
}
if ((prev = mutex->prev) != (pthread_mutex_t *)NULL)
{
prev->next = mutex->next;
} else
{
if (self != (pthread_t)0) {
self->mutexes = n;
}
}
}
#endif
int
pthread_mutex_lock(pthread_mutex_t *mutex)
{
kern_return_t kern_res;
pthread_t self;
int sig = mutex->sig;
if ((sig != _PTHREAD_MUTEX_SIG) && (sig != _PTHREAD_MUTEX_SIG_init))
return(EINVAL);
LOCK(mutex->lock);
if (mutex->sig != _PTHREAD_MUTEX_SIG)
{
if (mutex->sig != _PTHREAD_MUTEX_SIG_init)
{
UNLOCK(mutex->lock);
return (EINVAL);
}
_pthread_mutex_init(mutex, NULL);
self = _PTHREAD_MUTEX_OWNER_SELF;
}
else if (mutex->type != PTHREAD_MUTEX_NORMAL)
{
self = pthread_self();
if (mutex->owner == self)
{
int res;
if (mutex->type == PTHREAD_MUTEX_RECURSIVE)
{
if (mutex->lock_count < USHRT_MAX)
{
mutex->lock_count++;
res = ESUCCESS;
} else
res = EAGAIN;
} else
res = EDEADLK;
UNLOCK(mutex->lock);
return (res);
}
} else
self = _PTHREAD_MUTEX_OWNER_SELF;
if (mutex->owner != (pthread_t)NULL) {
if (mutex->waiters || mutex->owner != _PTHREAD_MUTEX_OWNER_SWITCHING)
{
semaphore_t sem, order;
if (++mutex->waiters == 1)
{
mutex->sem = sem = new_sem_from_pool();
mutex->order = order = new_sem_from_pool();
}
else
{
sem = mutex->sem;
order = mutex->order;
do {
PTHREAD_MACH_CALL(semaphore_wait(order), kern_res);
} while (kern_res == KERN_ABORTED);
}
UNLOCK(mutex->lock);
PTHREAD_MACH_CALL(semaphore_wait_signal(sem, order), kern_res);
while (kern_res == KERN_ABORTED)
{
PTHREAD_MACH_CALL(semaphore_wait(sem), kern_res);
}
LOCK(mutex->lock);
if (--mutex->waiters == 0)
{
PTHREAD_MACH_CALL(semaphore_wait(order), kern_res);
mutex->sem = mutex->order = SEMAPHORE_NULL;
restore_sem_to_pool(order);
restore_sem_to_pool(sem);
}
}
else if (mutex->owner == _PTHREAD_MUTEX_OWNER_SWITCHING)
{
semaphore_t sem = mutex->sem;
do {
PTHREAD_MACH_CALL(semaphore_wait(sem), kern_res);
} while (kern_res == KERN_ABORTED);
mutex->sem = SEMAPHORE_NULL;
restore_sem_to_pool(sem);
}
}
mutex->lock_count = 1;
mutex->owner = self;
#if defined(DEBUG)
_pthread_mutex_add(mutex, self);
#endif
UNLOCK(mutex->lock);
return (ESUCCESS);
}
int
pthread_mutex_trylock(pthread_mutex_t *mutex)
{
kern_return_t kern_res;
pthread_t self;
LOCK(mutex->lock);
if (mutex->sig != _PTHREAD_MUTEX_SIG)
{
if (mutex->sig != _PTHREAD_MUTEX_SIG_init)
{
UNLOCK(mutex->lock);
return (EINVAL);
}
_pthread_mutex_init(mutex, NULL);
self = _PTHREAD_MUTEX_OWNER_SELF;
}
else if (mutex->type != PTHREAD_MUTEX_NORMAL)
{
self = pthread_self();
if (mutex->type == PTHREAD_MUTEX_RECURSIVE)
{
if (mutex->owner == self)
{
int res;
if (mutex->lock_count < USHRT_MAX)
{
mutex->lock_count++;
res = ESUCCESS;
} else
res = EAGAIN;
UNLOCK(mutex->lock);
return (res);
}
}
} else
self = _PTHREAD_MUTEX_OWNER_SELF;
if (mutex->owner != (pthread_t)NULL)
{
if (mutex->waiters || mutex->owner != _PTHREAD_MUTEX_OWNER_SWITCHING)
{
UNLOCK(mutex->lock);
return (EBUSY);
}
else if (mutex->owner == _PTHREAD_MUTEX_OWNER_SWITCHING)
{
semaphore_t sem = mutex->sem;
do {
PTHREAD_MACH_CALL(semaphore_wait(sem), kern_res);
} while (kern_res == KERN_ABORTED);
restore_sem_to_pool(sem);
mutex->sem = SEMAPHORE_NULL;
}
}
mutex->lock_count = 1;
mutex->owner = self;
#if defined(DEBUG)
_pthread_mutex_add(mutex, self);
#endif
UNLOCK(mutex->lock);
return (ESUCCESS);
}
int
pthread_mutex_unlock(pthread_mutex_t *mutex)
{
kern_return_t kern_res;
int waiters;
int sig = mutex->sig;
if ((sig != _PTHREAD_MUTEX_SIG) && (sig != _PTHREAD_MUTEX_SIG_init))
return(EINVAL);
LOCK(mutex->lock);
if (mutex->sig != _PTHREAD_MUTEX_SIG)
{
if (mutex->sig != _PTHREAD_MUTEX_SIG_init)
{
UNLOCK(mutex->lock);
return (EINVAL);
}
_pthread_mutex_init(mutex, NULL);
} else
#if !defined(DEBUG)
if (mutex->type != PTHREAD_MUTEX_NORMAL)
#endif
{
pthread_t self = pthread_self();
if (mutex->owner != self)
{
#if defined(DEBUG)
abort();
#endif
UNLOCK(mutex->lock);
return EPERM;
} else if (mutex->type == PTHREAD_MUTEX_RECURSIVE &&
--mutex->lock_count)
{
UNLOCK(mutex->lock);
return ESUCCESS;
}
}
mutex->lock_count = 0;
#if defined(DEBUG)
_pthread_mutex_remove(mutex, mutex->owner);
#endif
waiters = mutex->waiters;
if (waiters)
{
mutex->owner = _PTHREAD_MUTEX_OWNER_SWITCHING;
UNLOCK(mutex->lock);
PTHREAD_MACH_CALL(semaphore_signal(mutex->sem), kern_res);
}
else
{
mutex->owner = (pthread_t)NULL;
UNLOCK(mutex->lock);
}
return (ESUCCESS);
}
int
pthread_mutex_getprioceiling(const pthread_mutex_t *mutex,
int *prioceiling)
{
int res;
LOCK(mutex->lock);
if (mutex->sig == _PTHREAD_MUTEX_SIG)
{
*prioceiling = mutex->prioceiling;
res = ESUCCESS;
} else
res = EINVAL;
UNLOCK(mutex->lock);
return (res);
}
int
pthread_mutex_setprioceiling(pthread_mutex_t *mutex,
int prioceiling,
int *old_prioceiling)
{
int res;
LOCK(mutex->lock);
if (mutex->sig == _PTHREAD_MUTEX_SIG)
{
if ((prioceiling >= -999) ||
(prioceiling <= 999))
{
*old_prioceiling = mutex->prioceiling;
mutex->prioceiling = prioceiling;
res = ESUCCESS;
} else
res = EINVAL;
} else
res = EINVAL;
UNLOCK(mutex->lock);
return (res);
}
int
pthread_mutexattr_destroy(pthread_mutexattr_t *attr)
{
attr->sig = _PTHREAD_NO_SIG;
return (ESUCCESS);
}
int
pthread_mutexattr_getprioceiling(const pthread_mutexattr_t *attr,
int *prioceiling)
{
if (attr->sig == _PTHREAD_MUTEX_ATTR_SIG)
{
*prioceiling = attr->prioceiling;
return (ESUCCESS);
} else
{
return (EINVAL);
}
}
int
pthread_mutexattr_getprotocol(const pthread_mutexattr_t *attr,
int *protocol)
{
if (attr->sig == _PTHREAD_MUTEX_ATTR_SIG)
{
*protocol = attr->protocol;
return (ESUCCESS);
} else
{
return (EINVAL);
}
}
int
pthread_mutexattr_gettype(const pthread_mutexattr_t *attr,
int *type)
{
if (attr->sig == _PTHREAD_MUTEX_ATTR_SIG)
{
*type = attr->type;
return (ESUCCESS);
} else
{
return (EINVAL);
}
}
int
pthread_mutexattr_getpshared(const pthread_mutexattr_t *attr, int *pshared)
{
if (attr->sig == _PTHREAD_MUTEX_ATTR_SIG)
{
*pshared = (int)PTHREAD_PROCESS_PRIVATE;
return (ESUCCESS);
} else
{
return (EINVAL);
}
}
int
pthread_mutexattr_init(pthread_mutexattr_t *attr)
{
attr->prioceiling = _PTHREAD_DEFAULT_PRIOCEILING;
attr->protocol = _PTHREAD_DEFAULT_PROTOCOL;
attr->type = PTHREAD_MUTEX_DEFAULT;
attr->sig = _PTHREAD_MUTEX_ATTR_SIG;
return (ESUCCESS);
}
int
pthread_mutexattr_setprioceiling(pthread_mutexattr_t *attr,
int prioceiling)
{
if (attr->sig == _PTHREAD_MUTEX_ATTR_SIG)
{
if ((prioceiling >= -999) ||
(prioceiling <= 999))
{
attr->prioceiling = prioceiling;
return (ESUCCESS);
} else
{
return (EINVAL);
}
} else
{
return (EINVAL);
}
}
int
pthread_mutexattr_setprotocol(pthread_mutexattr_t *attr,
int protocol)
{
if (attr->sig == _PTHREAD_MUTEX_ATTR_SIG)
{
if ((protocol == PTHREAD_PRIO_NONE) ||
(protocol == PTHREAD_PRIO_INHERIT) ||
(protocol == PTHREAD_PRIO_PROTECT))
{
attr->protocol = protocol;
return (ESUCCESS);
} else
{
return (EINVAL);
}
} else
{
return (EINVAL);
}
}
int
pthread_mutexattr_settype(pthread_mutexattr_t *attr,
int type)
{
if (attr->sig == _PTHREAD_MUTEX_ATTR_SIG)
{
if ((type == PTHREAD_MUTEX_NORMAL) ||
(type == PTHREAD_MUTEX_ERRORCHECK) ||
(type == PTHREAD_MUTEX_RECURSIVE) ||
(type == PTHREAD_MUTEX_DEFAULT))
{
attr->type = type;
return (ESUCCESS);
} else
{
return (EINVAL);
}
} else
{
return (EINVAL);
}
}
int
pthread_mutexattr_setpshared(pthread_mutexattr_t *attr, int pshared)
{
if (attr->sig == _PTHREAD_MUTEX_ATTR_SIG)
{
if (pshared == PTHREAD_PROCESS_PRIVATE)
{
return (ESUCCESS);
} else
{
return (EINVAL);
}
} else
{
return (EINVAL);
}
}
int mutex_try_lock(int *x) {
return _spin_lock_try((pthread_lock_t *)x);
}
void mutex_wait_lock(int *x) {
for (;;) {
if( _spin_lock_try((pthread_lock_t *)x)) {
return;
}
swtch_pri(0);
}
}
void
cthread_yield(void)
{
sched_yield();
}
void
pthread_yield_np (void)
{
sched_yield();
}