120 lines
2.4 KiB
C
120 lines
2.4 KiB
C
|
// SPDX-License-Identifier: GPL-2.0
|
||
|
#include "mutex.h"
|
||
|
|
||
|
#include "debug.h"
|
||
|
#include <linux/string.h>
|
||
|
#include <errno.h>
|
||
|
|
||
|
static void check_err(const char *fn, int err)
|
||
|
{
|
||
|
char sbuf[STRERR_BUFSIZE];
|
||
|
|
||
|
if (err == 0)
|
||
|
return;
|
||
|
|
||
|
pr_err("%s error: '%s'\n", fn, str_error_r(err, sbuf, sizeof(sbuf)));
|
||
|
}
|
||
|
|
||
|
#define CHECK_ERR(err) check_err(__func__, err)
|
||
|
|
||
|
static void __mutex_init(struct mutex *mtx, bool pshared)
|
||
|
{
|
||
|
pthread_mutexattr_t attr;
|
||
|
|
||
|
CHECK_ERR(pthread_mutexattr_init(&attr));
|
||
|
|
||
|
#ifndef NDEBUG
|
||
|
/* In normal builds enable error checking, such as recursive usage. */
|
||
|
CHECK_ERR(pthread_mutexattr_settype(&attr, PTHREAD_MUTEX_ERRORCHECK));
|
||
|
#endif
|
||
|
if (pshared)
|
||
|
CHECK_ERR(pthread_mutexattr_setpshared(&attr, PTHREAD_PROCESS_SHARED));
|
||
|
|
||
|
CHECK_ERR(pthread_mutex_init(&mtx->lock, &attr));
|
||
|
CHECK_ERR(pthread_mutexattr_destroy(&attr));
|
||
|
}
|
||
|
|
||
|
void mutex_init(struct mutex *mtx)
|
||
|
{
|
||
|
__mutex_init(mtx, /*pshared=*/false);
|
||
|
}
|
||
|
|
||
|
void mutex_init_pshared(struct mutex *mtx)
|
||
|
{
|
||
|
__mutex_init(mtx, /*pshared=*/true);
|
||
|
}
|
||
|
|
||
|
void mutex_destroy(struct mutex *mtx)
|
||
|
{
|
||
|
CHECK_ERR(pthread_mutex_destroy(&mtx->lock));
|
||
|
}
|
||
|
|
||
|
void mutex_lock(struct mutex *mtx)
|
||
|
NO_THREAD_SAFETY_ANALYSIS
|
||
|
{
|
||
|
CHECK_ERR(pthread_mutex_lock(&mtx->lock));
|
||
|
}
|
||
|
|
||
|
void mutex_unlock(struct mutex *mtx)
|
||
|
NO_THREAD_SAFETY_ANALYSIS
|
||
|
{
|
||
|
CHECK_ERR(pthread_mutex_unlock(&mtx->lock));
|
||
|
}
|
||
|
|
||
|
bool mutex_trylock(struct mutex *mtx)
|
||
|
{
|
||
|
int ret = pthread_mutex_trylock(&mtx->lock);
|
||
|
|
||
|
if (ret == 0)
|
||
|
return true; /* Lock acquired. */
|
||
|
|
||
|
if (ret == EBUSY)
|
||
|
return false; /* Lock busy. */
|
||
|
|
||
|
/* Print error. */
|
||
|
CHECK_ERR(ret);
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
static void __cond_init(struct cond *cnd, bool pshared)
|
||
|
{
|
||
|
pthread_condattr_t attr;
|
||
|
|
||
|
CHECK_ERR(pthread_condattr_init(&attr));
|
||
|
if (pshared)
|
||
|
CHECK_ERR(pthread_condattr_setpshared(&attr, PTHREAD_PROCESS_SHARED));
|
||
|
|
||
|
CHECK_ERR(pthread_cond_init(&cnd->cond, &attr));
|
||
|
CHECK_ERR(pthread_condattr_destroy(&attr));
|
||
|
}
|
||
|
|
||
|
void cond_init(struct cond *cnd)
|
||
|
{
|
||
|
__cond_init(cnd, /*pshared=*/false);
|
||
|
}
|
||
|
|
||
|
void cond_init_pshared(struct cond *cnd)
|
||
|
{
|
||
|
__cond_init(cnd, /*pshared=*/true);
|
||
|
}
|
||
|
|
||
|
void cond_destroy(struct cond *cnd)
|
||
|
{
|
||
|
CHECK_ERR(pthread_cond_destroy(&cnd->cond));
|
||
|
}
|
||
|
|
||
|
void cond_wait(struct cond *cnd, struct mutex *mtx)
|
||
|
{
|
||
|
CHECK_ERR(pthread_cond_wait(&cnd->cond, &mtx->lock));
|
||
|
}
|
||
|
|
||
|
void cond_signal(struct cond *cnd)
|
||
|
{
|
||
|
CHECK_ERR(pthread_cond_signal(&cnd->cond));
|
||
|
}
|
||
|
|
||
|
void cond_broadcast(struct cond *cnd)
|
||
|
{
|
||
|
CHECK_ERR(pthread_cond_broadcast(&cnd->cond));
|
||
|
}
|