2015-11-21 19:36:47 -07:00
|
|
|
/*
|
|
|
|
* C11 <threads.h> emulation library
|
|
|
|
*
|
|
|
|
* (C) Copyright yohhoy 2012.
|
|
|
|
* Distributed under the Boost Software License, Version 1.0.
|
|
|
|
*
|
|
|
|
* Permission is hereby granted, free of charge, to any person or organization
|
|
|
|
* obtaining a copy of the software and accompanying documentation covered by
|
|
|
|
* this license (the "Software") to use, reproduce, display, distribute,
|
|
|
|
* execute, and transmit the Software, and to prepare [[derivative work]]s of the
|
|
|
|
* Software, and to permit third-parties to whom the Software is furnished to
|
|
|
|
* do so, all subject to the following:
|
|
|
|
*
|
|
|
|
* The copyright notices in the Software and this entire statement, including
|
|
|
|
* the above license grant, this restriction and the following disclaimer,
|
|
|
|
* must be included in all copies of the Software, in whole or in part, and
|
|
|
|
* all derivative works of the Software, unless such copies or derivative
|
|
|
|
* works are solely in the form of machine-executable object code generated by
|
|
|
|
* a source language processor.
|
|
|
|
*
|
|
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
|
|
* FITNESS FOR A PARTICULAR PURPOSE, TITLE AND NON-INFRINGEMENT. IN NO EVENT
|
|
|
|
* SHALL THE COPYRIGHT HOLDERS OR ANYONE DISTRIBUTING THE SOFTWARE BE LIABLE
|
|
|
|
* FOR ANY DAMAGES OR OTHER LIABILITY, WHETHER IN CONTRACT, TORT OR OTHERWISE,
|
|
|
|
* ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
|
|
|
|
* DEALINGS IN THE SOFTWARE.
|
|
|
|
*/
|
|
|
|
#include <stdlib.h>
|
|
|
|
#ifndef assert
|
|
|
|
#include <assert.h>
|
|
|
|
#endif
|
|
|
|
#include <limits.h>
|
|
|
|
#include <errno.h>
|
|
|
|
#include <unistd.h>
|
|
|
|
#include <sched.h>
|
|
|
|
#include <stdint.h> /* for intptr_t */
|
|
|
|
|
|
|
|
/*
|
|
|
|
Configuration macro:
|
|
|
|
|
|
|
|
EMULATED_THREADS_USE_NATIVE_TIMEDLOCK
|
|
|
|
Use pthread_mutex_timedlock() for `mtx_timedlock()'
|
|
|
|
Otherwise use mtx_trylock() + *busy loop* emulation.
|
|
|
|
*/
|
|
|
|
#if !defined(__CYGWIN__) && !defined(__APPLE__) && !defined(__NetBSD__)
|
|
|
|
#define EMULATED_THREADS_USE_NATIVE_TIMEDLOCK
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
#include <pthread.h>
|
|
|
|
|
|
|
|
/*---------------------------- macros ----------------------------*/
|
|
|
|
#define ONCE_FLAG_INIT PTHREAD_ONCE_INIT
|
|
|
|
#ifdef INIT_ONCE_STATIC_INIT
|
|
|
|
#define TSS_DTOR_ITERATIONS PTHREAD_DESTRUCTOR_ITERATIONS
|
|
|
|
#else
|
|
|
|
#define TSS_DTOR_ITERATIONS 1 // assume TSS dtor MAY be called at least once.
|
|
|
|
#endif
|
|
|
|
|
|
|
|
// FIXME: temporary non-standard hack to ease transition
|
|
|
|
#define _MTX_INITIALIZER_NP PTHREAD_MUTEX_INITIALIZER
|
|
|
|
|
|
|
|
/*---------------------------- types ----------------------------*/
|
|
|
|
typedef pthread_cond_t cnd_t;
|
|
|
|
typedef pthread_t thrd_t;
|
|
|
|
typedef pthread_key_t tss_t;
|
|
|
|
typedef pthread_mutex_t mtx_t;
|
|
|
|
typedef pthread_once_t once_flag;
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
Implementation limits:
|
|
|
|
- Conditionally emulation for "mutex with timeout"
|
|
|
|
(see EMULATED_THREADS_USE_NATIVE_TIMEDLOCK macro)
|
|
|
|
*/
|
|
|
|
struct impl_thrd_param {
|
|
|
|
thrd_start_t func;
|
|
|
|
void *arg;
|
|
|
|
};
|
|
|
|
|
|
|
|
static inline void *
|
|
|
|
impl_thrd_routine(void *p)
|
|
|
|
{
|
|
|
|
struct impl_thrd_param pack = *((struct impl_thrd_param *)p);
|
|
|
|
free(p);
|
|
|
|
return (void*)(intptr_t)pack.func(pack.arg);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*--------------- 7.25.2 Initialization functions ---------------*/
|
|
|
|
// 7.25.2.1
|
|
|
|
static inline void
|
|
|
|
call_once(once_flag *flag, void (*func)(void))
|
|
|
|
{
|
|
|
|
pthread_once(flag, func);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*------------- 7.25.3 Condition variable functions -------------*/
|
|
|
|
// 7.25.3.1
|
|
|
|
static inline int
|
|
|
|
cnd_broadcast(cnd_t *cond)
|
|
|
|
{
|
2016-05-29 04:11:54 -06:00
|
|
|
assert(cond != NULL);
|
|
|
|
return (pthread_cond_broadcast(cond) == 0) ? thrd_success : thrd_error;
|
2015-11-21 19:36:47 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.3.2
|
|
|
|
static inline void
|
|
|
|
cnd_destroy(cnd_t *cond)
|
|
|
|
{
|
|
|
|
assert(cond);
|
|
|
|
pthread_cond_destroy(cond);
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.3.3
|
|
|
|
static inline int
|
|
|
|
cnd_init(cnd_t *cond)
|
|
|
|
{
|
2016-05-29 04:11:54 -06:00
|
|
|
assert(cond != NULL);
|
|
|
|
return (pthread_cond_init(cond, NULL) == 0) ? thrd_success : thrd_error;
|
2015-11-21 19:36:47 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.3.4
|
|
|
|
static inline int
|
|
|
|
cnd_signal(cnd_t *cond)
|
|
|
|
{
|
2016-05-29 04:11:54 -06:00
|
|
|
assert(cond != NULL);
|
|
|
|
return (pthread_cond_signal(cond) == 0) ? thrd_success : thrd_error;
|
2015-11-21 19:36:47 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.3.5
|
|
|
|
static inline int
|
|
|
|
cnd_timedwait(cnd_t *cond, mtx_t *mtx, const xtime *xt)
|
|
|
|
{
|
|
|
|
struct timespec abs_time;
|
|
|
|
int rt;
|
2016-05-29 04:11:54 -06:00
|
|
|
|
|
|
|
assert(mtx != NULL);
|
|
|
|
assert(cond != NULL);
|
|
|
|
assert(xt != NULL);
|
|
|
|
|
|
|
|
abs_time.tv_sec = xt->sec;
|
|
|
|
abs_time.tv_nsec = xt->nsec;
|
|
|
|
|
2015-11-21 19:36:47 -07:00
|
|
|
rt = pthread_cond_timedwait(cond, mtx, &abs_time);
|
|
|
|
if (rt == ETIMEDOUT)
|
|
|
|
return thrd_busy;
|
|
|
|
return (rt == 0) ? thrd_success : thrd_error;
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.3.6
|
|
|
|
static inline int
|
|
|
|
cnd_wait(cnd_t *cond, mtx_t *mtx)
|
|
|
|
{
|
2016-05-29 04:11:54 -06:00
|
|
|
assert(mtx != NULL);
|
|
|
|
assert(cond != NULL);
|
|
|
|
return (pthread_cond_wait(cond, mtx) == 0) ? thrd_success : thrd_error;
|
2015-11-21 19:36:47 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*-------------------- 7.25.4 Mutex functions --------------------*/
|
|
|
|
// 7.25.4.1
|
|
|
|
static inline void
|
|
|
|
mtx_destroy(mtx_t *mtx)
|
|
|
|
{
|
2016-05-29 04:11:54 -06:00
|
|
|
assert(mtx != NULL);
|
2015-11-21 19:36:47 -07:00
|
|
|
pthread_mutex_destroy(mtx);
|
|
|
|
}
|
|
|
|
|
2016-12-11 01:25:29 -07:00
|
|
|
/*
|
|
|
|
* XXX: Workaround when building with -O0 and without pthreads link.
|
|
|
|
*
|
|
|
|
* In such cases constant folding and dead code elimination won't be
|
|
|
|
* available, thus the compiler will always add the pthread_mutexattr*
|
|
|
|
* functions into the binary. As we try to link, we'll fail as the
|
|
|
|
* symbols are unresolved.
|
|
|
|
*
|
|
|
|
* Ideally we'll enable the optimisations locally, yet that does not
|
|
|
|
* seem to work.
|
|
|
|
*
|
|
|
|
* So the alternative workaround is to annotate the symbols as weak.
|
|
|
|
* Thus the linker will be happy and things don't clash when building
|
|
|
|
* with -O1 or greater.
|
|
|
|
*/
|
|
|
|
#if defined(HAVE_FUNC_ATTRIBUTE_WEAK) && !defined(__CYGWIN__)
|
|
|
|
__attribute__((weak))
|
|
|
|
int pthread_mutexattr_init(pthread_mutexattr_t *attr);
|
|
|
|
|
|
|
|
__attribute__((weak))
|
|
|
|
int pthread_mutexattr_settype(pthread_mutexattr_t *attr, int type);
|
|
|
|
|
|
|
|
__attribute__((weak))
|
|
|
|
int pthread_mutexattr_destroy(pthread_mutexattr_t *attr);
|
|
|
|
#endif
|
|
|
|
|
2015-11-21 19:36:47 -07:00
|
|
|
// 7.25.4.2
|
|
|
|
static inline int
|
|
|
|
mtx_init(mtx_t *mtx, int type)
|
|
|
|
{
|
|
|
|
pthread_mutexattr_t attr;
|
2016-05-29 04:11:54 -06:00
|
|
|
assert(mtx != NULL);
|
2015-11-21 19:36:47 -07:00
|
|
|
if (type != mtx_plain && type != mtx_timed && type != mtx_try
|
|
|
|
&& type != (mtx_plain|mtx_recursive)
|
|
|
|
&& type != (mtx_timed|mtx_recursive)
|
|
|
|
&& type != (mtx_try|mtx_recursive))
|
|
|
|
return thrd_error;
|
2016-12-11 01:25:29 -07:00
|
|
|
|
|
|
|
if ((type & mtx_recursive) == 0) {
|
|
|
|
pthread_mutex_init(mtx, NULL);
|
|
|
|
return thrd_success;
|
|
|
|
}
|
|
|
|
|
2015-11-21 19:36:47 -07:00
|
|
|
pthread_mutexattr_init(&attr);
|
2016-12-11 01:25:29 -07:00
|
|
|
pthread_mutexattr_settype(&attr, PTHREAD_MUTEX_RECURSIVE);
|
2015-11-21 19:36:47 -07:00
|
|
|
pthread_mutex_init(mtx, &attr);
|
|
|
|
pthread_mutexattr_destroy(&attr);
|
|
|
|
return thrd_success;
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.4.3
|
|
|
|
static inline int
|
|
|
|
mtx_lock(mtx_t *mtx)
|
|
|
|
{
|
2016-05-29 04:11:54 -06:00
|
|
|
assert(mtx != NULL);
|
|
|
|
return (pthread_mutex_lock(mtx) == 0) ? thrd_success : thrd_error;
|
2015-11-21 19:36:47 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
static inline int
|
|
|
|
mtx_trylock(mtx_t *mtx);
|
|
|
|
|
|
|
|
static inline void
|
|
|
|
thrd_yield(void);
|
|
|
|
|
|
|
|
// 7.25.4.4
|
|
|
|
static inline int
|
|
|
|
mtx_timedlock(mtx_t *mtx, const xtime *xt)
|
|
|
|
{
|
2016-05-29 04:11:54 -06:00
|
|
|
assert(mtx != NULL);
|
|
|
|
assert(xt != NULL);
|
|
|
|
|
2015-11-21 19:36:47 -07:00
|
|
|
{
|
|
|
|
#ifdef EMULATED_THREADS_USE_NATIVE_TIMEDLOCK
|
|
|
|
struct timespec ts;
|
|
|
|
int rt;
|
|
|
|
ts.tv_sec = xt->sec;
|
|
|
|
ts.tv_nsec = xt->nsec;
|
|
|
|
rt = pthread_mutex_timedlock(mtx, &ts);
|
|
|
|
if (rt == 0)
|
|
|
|
return thrd_success;
|
|
|
|
return (rt == ETIMEDOUT) ? thrd_busy : thrd_error;
|
|
|
|
#else
|
|
|
|
time_t expire = time(NULL);
|
|
|
|
expire += xt->sec;
|
|
|
|
while (mtx_trylock(mtx) != thrd_success) {
|
|
|
|
time_t now = time(NULL);
|
|
|
|
if (expire < now)
|
|
|
|
return thrd_busy;
|
|
|
|
// busy loop!
|
|
|
|
thrd_yield();
|
|
|
|
}
|
|
|
|
return thrd_success;
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.4.5
|
|
|
|
static inline int
|
|
|
|
mtx_trylock(mtx_t *mtx)
|
|
|
|
{
|
2016-05-29 04:11:54 -06:00
|
|
|
assert(mtx != NULL);
|
2015-11-21 19:36:47 -07:00
|
|
|
return (pthread_mutex_trylock(mtx) == 0) ? thrd_success : thrd_busy;
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.4.6
|
|
|
|
static inline int
|
|
|
|
mtx_unlock(mtx_t *mtx)
|
|
|
|
{
|
2016-05-29 04:11:54 -06:00
|
|
|
assert(mtx != NULL);
|
|
|
|
return (pthread_mutex_unlock(mtx) == 0) ? thrd_success : thrd_error;
|
2015-11-21 19:36:47 -07:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*------------------- 7.25.5 Thread functions -------------------*/
|
|
|
|
// 7.25.5.1
|
|
|
|
static inline int
|
|
|
|
thrd_create(thrd_t *thr, thrd_start_t func, void *arg)
|
|
|
|
{
|
|
|
|
struct impl_thrd_param *pack;
|
2016-05-29 04:11:54 -06:00
|
|
|
assert(thr != NULL);
|
2015-11-21 19:36:47 -07:00
|
|
|
pack = (struct impl_thrd_param *)malloc(sizeof(struct impl_thrd_param));
|
|
|
|
if (!pack) return thrd_nomem;
|
|
|
|
pack->func = func;
|
|
|
|
pack->arg = arg;
|
|
|
|
if (pthread_create(thr, NULL, impl_thrd_routine, pack) != 0) {
|
|
|
|
free(pack);
|
|
|
|
return thrd_error;
|
|
|
|
}
|
|
|
|
return thrd_success;
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.5.2
|
|
|
|
static inline thrd_t
|
|
|
|
thrd_current(void)
|
|
|
|
{
|
|
|
|
return pthread_self();
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.5.3
|
|
|
|
static inline int
|
|
|
|
thrd_detach(thrd_t thr)
|
|
|
|
{
|
|
|
|
return (pthread_detach(thr) == 0) ? thrd_success : thrd_error;
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.5.4
|
|
|
|
static inline int
|
|
|
|
thrd_equal(thrd_t thr0, thrd_t thr1)
|
|
|
|
{
|
|
|
|
return pthread_equal(thr0, thr1);
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.5.5
|
|
|
|
static inline void
|
|
|
|
thrd_exit(int res)
|
|
|
|
{
|
|
|
|
pthread_exit((void*)(intptr_t)res);
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.5.6
|
|
|
|
static inline int
|
|
|
|
thrd_join(thrd_t thr, int *res)
|
|
|
|
{
|
|
|
|
void *code;
|
|
|
|
if (pthread_join(thr, &code) != 0)
|
|
|
|
return thrd_error;
|
|
|
|
if (res)
|
|
|
|
*res = (int)(intptr_t)code;
|
|
|
|
return thrd_success;
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.5.7
|
|
|
|
static inline void
|
|
|
|
thrd_sleep(const xtime *xt)
|
|
|
|
{
|
|
|
|
struct timespec req;
|
|
|
|
assert(xt);
|
|
|
|
req.tv_sec = xt->sec;
|
|
|
|
req.tv_nsec = xt->nsec;
|
|
|
|
nanosleep(&req, NULL);
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.5.8
|
|
|
|
static inline void
|
|
|
|
thrd_yield(void)
|
|
|
|
{
|
|
|
|
sched_yield();
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*----------- 7.25.6 Thread-specific storage functions -----------*/
|
|
|
|
// 7.25.6.1
|
|
|
|
static inline int
|
|
|
|
tss_create(tss_t *key, tss_dtor_t dtor)
|
|
|
|
{
|
2016-05-29 04:11:54 -06:00
|
|
|
assert(key != NULL);
|
2015-11-21 19:36:47 -07:00
|
|
|
return (pthread_key_create(key, dtor) == 0) ? thrd_success : thrd_error;
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.6.2
|
|
|
|
static inline void
|
|
|
|
tss_delete(tss_t key)
|
|
|
|
{
|
|
|
|
pthread_key_delete(key);
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.6.3
|
|
|
|
static inline void *
|
|
|
|
tss_get(tss_t key)
|
|
|
|
{
|
|
|
|
return pthread_getspecific(key);
|
|
|
|
}
|
|
|
|
|
|
|
|
// 7.25.6.4
|
|
|
|
static inline int
|
|
|
|
tss_set(tss_t key, void *val)
|
|
|
|
{
|
|
|
|
return (pthread_setspecific(key, val) == 0) ? thrd_success : thrd_error;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*-------------------- 7.25.7 Time functions --------------------*/
|
|
|
|
// 7.25.6.1
|
|
|
|
static inline int
|
|
|
|
xtime_get(xtime *xt, int base)
|
|
|
|
{
|
|
|
|
if (!xt) return 0;
|
|
|
|
if (base == TIME_UTC) {
|
|
|
|
xt->sec = time(NULL);
|
|
|
|
xt->nsec = 0;
|
|
|
|
return base;
|
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|