107 lines
2.9 KiB
C
107 lines
2.9 KiB
C
/*
|
|
* This file is part of the MicroPython project, http://micropython.org/
|
|
*
|
|
* The MIT License (MIT)
|
|
*
|
|
* Copyright (c) 2016 Damien P. George on behalf of Pycom Ltd
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
* in the Software without restriction, including without limitation the rights
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included in
|
|
* all copies or substantial portions of the Software.
|
|
*
|
|
* 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 AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
* THE SOFTWARE.
|
|
*/
|
|
|
|
#include <errno.h>
|
|
|
|
#include "py/mpstate.h"
|
|
#include "py/mpthread.h"
|
|
|
|
#if MICROPY_PY_THREAD
|
|
|
|
STATIC pthread_key_t tls_key;
|
|
|
|
void mp_thread_init(void) {
|
|
pthread_key_create(&tls_key, NULL);
|
|
pthread_setspecific(tls_key, &mp_state_ctx.thread);
|
|
}
|
|
|
|
mp_state_thread_t *mp_thread_get_state(void) {
|
|
return (mp_state_thread_t*)pthread_getspecific(tls_key);
|
|
}
|
|
|
|
void mp_thread_set_state(void *state) {
|
|
pthread_setspecific(tls_key, state);
|
|
}
|
|
|
|
void mp_thread_create(void *(*entry)(void*), void *arg, size_t stack_size) {
|
|
// default stack size is 8k machine-words
|
|
if (stack_size == 0) {
|
|
stack_size = 8192 * BYTES_PER_WORD;
|
|
}
|
|
|
|
// set thread attributes
|
|
pthread_attr_t attr;
|
|
int ret = pthread_attr_init(&attr);
|
|
if (ret != 0) {
|
|
goto er;
|
|
}
|
|
ret = pthread_attr_setstacksize(&attr, stack_size);
|
|
if (ret != 0) {
|
|
goto er;
|
|
}
|
|
|
|
// create thread
|
|
pthread_t id;
|
|
ret = pthread_create(&id, &attr, entry, arg);
|
|
if (ret != 0) {
|
|
goto er;
|
|
}
|
|
|
|
return;
|
|
|
|
er:
|
|
nlr_raise(mp_obj_new_exception_arg1(&mp_type_OSError, MP_OBJ_NEW_SMALL_INT(ret)));
|
|
}
|
|
|
|
void mp_thread_mutex_init(mp_thread_mutex_t *mutex) {
|
|
pthread_mutex_init(mutex, NULL);
|
|
}
|
|
|
|
int mp_thread_mutex_lock(mp_thread_mutex_t *mutex, int wait) {
|
|
int ret;
|
|
if (wait) {
|
|
ret = pthread_mutex_lock(mutex);
|
|
if (ret == 0) {
|
|
return 1;
|
|
}
|
|
} else {
|
|
ret = pthread_mutex_trylock(mutex);
|
|
if (ret == 0) {
|
|
return 1;
|
|
} else if (ret == EBUSY) {
|
|
return 0;
|
|
}
|
|
}
|
|
return -ret;
|
|
}
|
|
|
|
void mp_thread_mutex_unlock(mp_thread_mutex_t *mutex) {
|
|
pthread_mutex_unlock(mutex);
|
|
// TODO check return value
|
|
}
|
|
|
|
#endif // MICROPY_PY_THREAD
|