import RT-Thread@9217865c without bsp, libcpu and components/net
This commit is contained in:
commit
e2376a3709
1414 changed files with 390370 additions and 0 deletions
9
components/libc/posix/pthreads/SConscript
Normal file
9
components/libc/posix/pthreads/SConscript
Normal file
|
@ -0,0 +1,9 @@
|
|||
from building import *
|
||||
|
||||
cwd = GetCurrentDir()
|
||||
src = Glob('*.c')
|
||||
CPPPATH = [cwd]
|
||||
|
||||
group = DefineGroup('POSIX', src, depend = ['RT_USING_PTHREADS'], CPPPATH = CPPPATH)
|
||||
|
||||
Return('group')
|
26
components/libc/posix/pthreads/posix_types.h
Normal file
26
components/libc/posix/pthreads/posix_types.h
Normal file
|
@ -0,0 +1,26 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2013-12-23 Bernard Add the checking for ESHUTDOWN
|
||||
*/
|
||||
|
||||
#ifndef __POSIX_TYPES_H__
|
||||
#define __POSIX_TYPES_H__
|
||||
|
||||
#include <rtthread.h>
|
||||
|
||||
#include <stddef.h>
|
||||
#include <stdarg.h>
|
||||
#include <string.h>
|
||||
|
||||
#include <sys/types.h>
|
||||
#include <sys/time.h>
|
||||
#include <unistd.h>
|
||||
#include <sys/errno.h>
|
||||
#include <fcntl.h>
|
||||
|
||||
#endif
|
799
components/libc/posix/pthreads/pthread.c
Normal file
799
components/libc/posix/pthreads/pthread.c
Normal file
|
@ -0,0 +1,799 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2018-01-26 Bernard Fix pthread_detach issue for a none-joinable
|
||||
* thread.
|
||||
* 2019-02-07 Bernard Add _pthread_destroy to release pthread resource.
|
||||
* 2022-05-10 xiangxistu Modify the recycle logic about resource of pthread.
|
||||
*/
|
||||
|
||||
#include <rthw.h>
|
||||
#include <pthread.h>
|
||||
#include <sched.h>
|
||||
#include <sys/time.h>
|
||||
#include "pthread_internal.h"
|
||||
|
||||
RT_DEFINE_SPINLOCK(pth_lock);
|
||||
_pthread_data_t *pth_table[PTHREAD_NUM_MAX] = {NULL};
|
||||
static int concurrency_level;
|
||||
|
||||
_pthread_data_t *_pthread_get_data(pthread_t thread)
|
||||
{
|
||||
RT_DECLARE_SPINLOCK(pth_lock);
|
||||
_pthread_data_t *ptd;
|
||||
|
||||
if (thread >= PTHREAD_NUM_MAX) return NULL;
|
||||
|
||||
rt_hw_spin_lock(&pth_lock);
|
||||
ptd = pth_table[thread];
|
||||
rt_hw_spin_unlock(&pth_lock);
|
||||
|
||||
if (ptd && ptd->magic == PTHREAD_MAGIC) return ptd;
|
||||
|
||||
return NULL;
|
||||
}
|
||||
|
||||
pthread_t _pthread_data_get_pth(_pthread_data_t *ptd)
|
||||
{
|
||||
int index;
|
||||
RT_DECLARE_SPINLOCK(pth_lock);
|
||||
|
||||
rt_hw_spin_lock(&pth_lock);
|
||||
for (index = 0; index < PTHREAD_NUM_MAX; index ++)
|
||||
{
|
||||
if (pth_table[index] == ptd) break;
|
||||
}
|
||||
rt_hw_spin_unlock(&pth_lock);
|
||||
|
||||
return index;
|
||||
}
|
||||
|
||||
pthread_t _pthread_data_create(void)
|
||||
{
|
||||
int index;
|
||||
_pthread_data_t *ptd = NULL;
|
||||
RT_DECLARE_SPINLOCK(pth_lock);
|
||||
|
||||
ptd = (_pthread_data_t*)rt_malloc(sizeof(_pthread_data_t));
|
||||
if (!ptd) return PTHREAD_NUM_MAX;
|
||||
|
||||
memset(ptd, 0x0, sizeof(_pthread_data_t));
|
||||
ptd->canceled = 0;
|
||||
ptd->cancelstate = PTHREAD_CANCEL_DISABLE;
|
||||
ptd->canceltype = PTHREAD_CANCEL_DEFERRED;
|
||||
ptd->magic = PTHREAD_MAGIC;
|
||||
|
||||
rt_hw_spin_lock(&pth_lock);
|
||||
for (index = 0; index < PTHREAD_NUM_MAX; index ++)
|
||||
{
|
||||
if (pth_table[index] == NULL)
|
||||
{
|
||||
pth_table[index] = ptd;
|
||||
break;
|
||||
}
|
||||
}
|
||||
rt_hw_spin_unlock(&pth_lock);
|
||||
|
||||
/* full of pthreads, clean magic and release ptd */
|
||||
if (index == PTHREAD_NUM_MAX)
|
||||
{
|
||||
ptd->magic = 0x0;
|
||||
rt_free(ptd);
|
||||
}
|
||||
|
||||
return index;
|
||||
}
|
||||
|
||||
void _pthread_data_destroy(_pthread_data_t *ptd)
|
||||
{
|
||||
RT_DECLARE_SPINLOCK(pth_lock);
|
||||
|
||||
extern _pthread_key_data_t _thread_keys[PTHREAD_KEY_MAX];
|
||||
pthread_t pth;
|
||||
|
||||
if (ptd)
|
||||
{
|
||||
/* if this thread create the local thread data,
|
||||
* destruct thread local key
|
||||
*/
|
||||
if (ptd->tls != RT_NULL)
|
||||
{
|
||||
void *data;
|
||||
rt_uint32_t index;
|
||||
for (index = 0; index < PTHREAD_KEY_MAX; index ++)
|
||||
{
|
||||
if (_thread_keys[index].is_used)
|
||||
{
|
||||
data = ptd->tls[index];
|
||||
if (data && _thread_keys[index].destructor)
|
||||
_thread_keys[index].destructor(data);
|
||||
}
|
||||
}
|
||||
|
||||
/* release tls area */
|
||||
rt_free(ptd->tls);
|
||||
ptd->tls = RT_NULL;
|
||||
}
|
||||
|
||||
pth = _pthread_data_get_pth(ptd);
|
||||
/* remove from pthread table */
|
||||
rt_hw_spin_lock(&pth_lock);
|
||||
pth_table[pth] = NULL;
|
||||
rt_hw_spin_unlock(&pth_lock);
|
||||
|
||||
/* delete joinable semaphore */
|
||||
if (ptd->joinable_sem != RT_NULL)
|
||||
{
|
||||
rt_sem_delete(ptd->joinable_sem);
|
||||
ptd->joinable_sem = RT_NULL;
|
||||
}
|
||||
|
||||
/* clean magic */
|
||||
ptd->magic = 0x0;
|
||||
|
||||
/* clear the "ptd->tid->pthread_data" */
|
||||
ptd->tid->pthread_data = RT_NULL;
|
||||
|
||||
/* free ptd */
|
||||
rt_free(ptd);
|
||||
}
|
||||
}
|
||||
|
||||
static void _pthread_cleanup(rt_thread_t tid)
|
||||
{
|
||||
/* clear cleanup function */
|
||||
tid->cleanup = RT_NULL;
|
||||
|
||||
/* restore tid stack */
|
||||
rt_free(tid->stack_addr);
|
||||
|
||||
/* restore tid control block */
|
||||
rt_free(tid);
|
||||
}
|
||||
|
||||
static void pthread_entry_stub(void *parameter)
|
||||
{
|
||||
void *value;
|
||||
_pthread_data_t *ptd;
|
||||
|
||||
ptd = (_pthread_data_t *)parameter;
|
||||
|
||||
/* execute pthread entry */
|
||||
value = ptd->thread_entry(ptd->thread_parameter);
|
||||
|
||||
/* According to "detachstate" to whether or not to recycle resource immediately */
|
||||
if (ptd->attr.detachstate == PTHREAD_CREATE_JOINABLE)
|
||||
{
|
||||
/* set value */
|
||||
ptd->return_value = value;
|
||||
rt_sem_release(ptd->joinable_sem);
|
||||
}
|
||||
else
|
||||
{
|
||||
/* release pthread resource */
|
||||
_pthread_data_destroy(ptd);
|
||||
}
|
||||
}
|
||||
|
||||
int pthread_create(pthread_t *pid,
|
||||
const pthread_attr_t *attr,
|
||||
void *(*start)(void *), void *parameter)
|
||||
{
|
||||
int ret = 0;
|
||||
void *stack;
|
||||
char name[RT_NAME_MAX];
|
||||
static rt_uint16_t pthread_number = 0;
|
||||
|
||||
pthread_t pth_id;
|
||||
_pthread_data_t *ptd;
|
||||
|
||||
/* pid shall be provided */
|
||||
RT_ASSERT(pid != RT_NULL);
|
||||
|
||||
/* allocate posix thread data */
|
||||
pth_id = _pthread_data_create();
|
||||
if (pth_id == PTHREAD_NUM_MAX)
|
||||
{
|
||||
ret = ENOMEM;
|
||||
goto __exit;
|
||||
}
|
||||
/* get pthread data */
|
||||
ptd = _pthread_get_data(pth_id);
|
||||
|
||||
RT_ASSERT(ptd != RT_NULL);
|
||||
|
||||
if (attr != RT_NULL)
|
||||
{
|
||||
ptd->attr = *attr;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* use default attribute */
|
||||
pthread_attr_init(&ptd->attr);
|
||||
}
|
||||
|
||||
if (ptd->attr.stacksize == 0)
|
||||
{
|
||||
ret = EINVAL;
|
||||
goto __exit;
|
||||
}
|
||||
|
||||
rt_snprintf(name, sizeof(name), "pth%02d", pthread_number ++);
|
||||
|
||||
/* pthread is a static thread object */
|
||||
ptd->tid = (rt_thread_t) rt_malloc(sizeof(struct rt_thread));
|
||||
if (ptd->tid == RT_NULL)
|
||||
{
|
||||
ret = ENOMEM;
|
||||
goto __exit;
|
||||
}
|
||||
memset(ptd->tid, 0, sizeof(struct rt_thread));
|
||||
|
||||
if (ptd->attr.detachstate == PTHREAD_CREATE_JOINABLE)
|
||||
{
|
||||
ptd->joinable_sem = rt_sem_create(name, 0, RT_IPC_FLAG_FIFO);
|
||||
if (ptd->joinable_sem == RT_NULL)
|
||||
{
|
||||
ret = ENOMEM;
|
||||
goto __exit;
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
ptd->joinable_sem = RT_NULL;
|
||||
}
|
||||
|
||||
/* set parameter */
|
||||
ptd->thread_entry = start;
|
||||
ptd->thread_parameter = parameter;
|
||||
|
||||
/* stack */
|
||||
if (ptd->attr.stackaddr == 0)
|
||||
{
|
||||
stack = (void *)rt_malloc(ptd->attr.stacksize);
|
||||
}
|
||||
else
|
||||
{
|
||||
stack = (void *)(ptd->attr.stackaddr);
|
||||
}
|
||||
|
||||
if (stack == RT_NULL)
|
||||
{
|
||||
ret = ENOMEM;
|
||||
goto __exit;
|
||||
}
|
||||
|
||||
/* initial this pthread to system */
|
||||
if (rt_thread_init(ptd->tid, name, pthread_entry_stub, ptd,
|
||||
stack, ptd->attr.stacksize,
|
||||
ptd->attr.schedparam.sched_priority, 20) != RT_EOK)
|
||||
{
|
||||
ret = EINVAL;
|
||||
goto __exit;
|
||||
}
|
||||
|
||||
/* set pthread id */
|
||||
*pid = pth_id;
|
||||
|
||||
/* set pthread cleanup function and ptd data */
|
||||
ptd->tid->cleanup = _pthread_cleanup;
|
||||
ptd->tid->pthread_data = (void *)ptd;
|
||||
|
||||
/* start thread */
|
||||
if (rt_thread_startup(ptd->tid) == RT_EOK)
|
||||
return 0;
|
||||
|
||||
/* start thread failed */
|
||||
rt_thread_detach(ptd->tid);
|
||||
ret = EINVAL;
|
||||
|
||||
__exit:
|
||||
if (pth_id != PTHREAD_NUM_MAX)
|
||||
{
|
||||
_pthread_data_destroy(ptd);
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
RTM_EXPORT(pthread_create);
|
||||
|
||||
int pthread_detach(pthread_t thread)
|
||||
{
|
||||
int ret = 0;
|
||||
_pthread_data_t *ptd = _pthread_get_data(thread);
|
||||
if (ptd == RT_NULL)
|
||||
{
|
||||
/* invalid pthread id */
|
||||
ret = EINVAL;
|
||||
goto __exit;
|
||||
}
|
||||
|
||||
if (ptd->attr.detachstate == PTHREAD_CREATE_DETACHED)
|
||||
{
|
||||
/* The implementation has detected that the value specified by thread does not refer
|
||||
* to a joinable thread.
|
||||
*/
|
||||
ret = EINVAL;
|
||||
goto __exit;
|
||||
}
|
||||
|
||||
if ((ptd->tid->stat & RT_THREAD_STAT_MASK) == RT_THREAD_CLOSE)
|
||||
{
|
||||
/* destroy this pthread */
|
||||
_pthread_data_destroy(ptd);
|
||||
goto __exit;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* change to detach state */
|
||||
ptd->attr.detachstate = PTHREAD_CREATE_DETACHED;
|
||||
|
||||
/* detach joinable semaphore */
|
||||
if (ptd->joinable_sem)
|
||||
{
|
||||
rt_sem_delete(ptd->joinable_sem);
|
||||
ptd->joinable_sem = RT_NULL;
|
||||
}
|
||||
}
|
||||
|
||||
__exit:
|
||||
return ret;
|
||||
}
|
||||
RTM_EXPORT(pthread_detach);
|
||||
|
||||
int pthread_join(pthread_t thread, void **value_ptr)
|
||||
{
|
||||
_pthread_data_t *ptd;
|
||||
rt_err_t result;
|
||||
|
||||
ptd = _pthread_get_data(thread);
|
||||
|
||||
if (ptd == RT_NULL)
|
||||
{
|
||||
return EINVAL; /* invalid pthread id */
|
||||
}
|
||||
|
||||
if (ptd && ptd->tid == rt_thread_self())
|
||||
{
|
||||
/* join self */
|
||||
return EDEADLK;
|
||||
}
|
||||
|
||||
if (ptd->attr.detachstate == PTHREAD_CREATE_DETACHED)
|
||||
{
|
||||
return EINVAL; /* join on a detached pthread */
|
||||
}
|
||||
|
||||
result = rt_sem_take(ptd->joinable_sem, RT_WAITING_FOREVER);
|
||||
if (result == RT_EOK)
|
||||
{
|
||||
/* get return value */
|
||||
if (value_ptr != RT_NULL)
|
||||
*value_ptr = ptd->return_value;
|
||||
|
||||
/* destroy this pthread */
|
||||
_pthread_data_destroy(ptd);
|
||||
}
|
||||
else
|
||||
{
|
||||
return ESRCH;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_join);
|
||||
|
||||
pthread_t pthread_self (void)
|
||||
{
|
||||
rt_thread_t tid;
|
||||
_pthread_data_t *ptd;
|
||||
|
||||
tid = rt_thread_self();
|
||||
if (tid == NULL) return PTHREAD_NUM_MAX;
|
||||
|
||||
/* get pthread data from pthread_data of thread */
|
||||
ptd = (_pthread_data_t *)rt_thread_self()->pthread_data;
|
||||
RT_ASSERT(ptd != RT_NULL);
|
||||
|
||||
return _pthread_data_get_pth(ptd);
|
||||
}
|
||||
RTM_EXPORT(pthread_self);
|
||||
|
||||
int pthread_getcpuclockid(pthread_t thread, clockid_t *clock_id)
|
||||
{
|
||||
if(_pthread_get_data(thread) == NULL)
|
||||
{
|
||||
return EINVAL;
|
||||
}
|
||||
|
||||
*clock_id = (clockid_t)rt_tick_get();
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_getcpuclockid);
|
||||
|
||||
int pthread_getconcurrency(void)
|
||||
{
|
||||
return concurrency_level;
|
||||
}
|
||||
RTM_EXPORT(pthread_getconcurrency);
|
||||
|
||||
int pthread_setconcurrency(int new_level)
|
||||
{
|
||||
concurrency_level = new_level;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_setconcurrency);
|
||||
|
||||
int pthread_getschedparam(pthread_t thread, int *policy, struct sched_param *param)
|
||||
{
|
||||
_pthread_data_t *ptd;
|
||||
|
||||
ptd = _pthread_get_data(thread);
|
||||
pthread_attr_getschedpolicy(&ptd->attr, policy);
|
||||
pthread_attr_getschedparam(&ptd->attr, param);
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_getschedparam);
|
||||
|
||||
int pthread_setschedparam(pthread_t thread, int policy, const struct sched_param *param)
|
||||
{
|
||||
_pthread_data_t *ptd;
|
||||
|
||||
ptd = _pthread_get_data(thread);
|
||||
pthread_attr_setschedpolicy(&ptd->attr, policy);
|
||||
pthread_attr_setschedparam(&ptd->attr, param);
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_setschedparam);
|
||||
|
||||
int pthread_setschedprio(pthread_t thread, int prio)
|
||||
{
|
||||
_pthread_data_t *ptd;
|
||||
struct sched_param param;
|
||||
|
||||
ptd = _pthread_get_data(thread);
|
||||
param.sched_priority = prio;
|
||||
pthread_attr_setschedparam(&ptd->attr, ¶m);
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_setschedprio);
|
||||
|
||||
void pthread_exit(void *value)
|
||||
{
|
||||
_pthread_data_t *ptd;
|
||||
_pthread_cleanup_t *cleanup;
|
||||
rt_thread_t tid;
|
||||
|
||||
if (rt_thread_self() == RT_NULL)
|
||||
{
|
||||
return;
|
||||
}
|
||||
|
||||
/* get pthread data from pthread_data of thread */
|
||||
ptd = (_pthread_data_t *)rt_thread_self()->pthread_data;
|
||||
|
||||
rt_enter_critical();
|
||||
/* disable cancel */
|
||||
ptd->cancelstate = PTHREAD_CANCEL_DISABLE;
|
||||
/* set return value */
|
||||
ptd->return_value = value;
|
||||
rt_exit_critical();
|
||||
|
||||
/*
|
||||
* When use pthread_exit to exit.
|
||||
* invoke pushed cleanup
|
||||
*/
|
||||
while (ptd->cleanup != RT_NULL)
|
||||
{
|
||||
cleanup = ptd->cleanup;
|
||||
ptd->cleanup = cleanup->next;
|
||||
|
||||
cleanup->cleanup_func(cleanup->parameter);
|
||||
/* release this cleanup function */
|
||||
rt_free(cleanup);
|
||||
}
|
||||
|
||||
/* get the info aboult "tid" early */
|
||||
tid = ptd->tid;
|
||||
|
||||
/* According to "detachstate" to whether or not to recycle resource immediately */
|
||||
if (ptd->attr.detachstate == PTHREAD_CREATE_JOINABLE)
|
||||
{
|
||||
/* set value */
|
||||
rt_sem_release(ptd->joinable_sem);
|
||||
}
|
||||
else
|
||||
{
|
||||
/* release pthread resource */
|
||||
_pthread_data_destroy(ptd);
|
||||
}
|
||||
|
||||
/*
|
||||
* second: detach thread.
|
||||
* this thread will be removed from scheduler list
|
||||
* and because there is a cleanup function in the
|
||||
* thread (pthread_cleanup), it will move to defunct
|
||||
* thread list and wait for handling in idle thread.
|
||||
*/
|
||||
rt_thread_detach(tid);
|
||||
|
||||
/* reschedule thread */
|
||||
rt_schedule();
|
||||
}
|
||||
RTM_EXPORT(pthread_exit);
|
||||
|
||||
int pthread_once(pthread_once_t *once_control, void (*init_routine)(void))
|
||||
{
|
||||
RT_ASSERT(once_control != RT_NULL);
|
||||
RT_ASSERT(init_routine != RT_NULL);
|
||||
|
||||
rt_enter_critical();
|
||||
if (!(*once_control))
|
||||
{
|
||||
/* call routine once */
|
||||
*once_control = 1;
|
||||
rt_exit_critical();
|
||||
|
||||
init_routine();
|
||||
}
|
||||
rt_exit_critical();
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_once);
|
||||
|
||||
int pthread_atfork(void (*prepare)(void), void (*parent)(void), void (*child)(void))
|
||||
{
|
||||
return EOPNOTSUPP;
|
||||
}
|
||||
RTM_EXPORT(pthread_atfork);
|
||||
|
||||
int pthread_kill(pthread_t thread, int sig)
|
||||
{
|
||||
#ifdef RT_USING_SIGNALS
|
||||
_pthread_data_t *ptd;
|
||||
int ret;
|
||||
|
||||
ptd = _pthread_get_data(thread);
|
||||
if (ptd)
|
||||
{
|
||||
ret = rt_thread_kill(ptd->tid, sig);
|
||||
if (ret == -RT_EINVAL)
|
||||
{
|
||||
return EINVAL;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
return ESRCH;
|
||||
#else
|
||||
return ENOSYS;
|
||||
#endif
|
||||
}
|
||||
RTM_EXPORT(pthread_kill);
|
||||
|
||||
#ifdef RT_USING_SIGNALS
|
||||
int pthread_sigmask(int how, const sigset_t *set, sigset_t *oset)
|
||||
{
|
||||
return sigprocmask(how, set, oset);
|
||||
}
|
||||
#endif
|
||||
|
||||
void pthread_cleanup_pop(int execute)
|
||||
{
|
||||
_pthread_data_t *ptd;
|
||||
_pthread_cleanup_t *cleanup;
|
||||
|
||||
if (rt_thread_self() == NULL) return;
|
||||
|
||||
/* get pthread data from pthread_data of thread */
|
||||
ptd = (_pthread_data_t *)rt_thread_self()->pthread_data;
|
||||
RT_ASSERT(ptd != RT_NULL);
|
||||
|
||||
if (execute)
|
||||
{
|
||||
rt_enter_critical();
|
||||
cleanup = ptd->cleanup;
|
||||
if (cleanup)
|
||||
ptd->cleanup = cleanup->next;
|
||||
rt_exit_critical();
|
||||
|
||||
if (cleanup)
|
||||
{
|
||||
cleanup->cleanup_func(cleanup->parameter);
|
||||
|
||||
rt_free(cleanup);
|
||||
}
|
||||
}
|
||||
}
|
||||
RTM_EXPORT(pthread_cleanup_pop);
|
||||
|
||||
void pthread_cleanup_push(void (*routine)(void *), void *arg)
|
||||
{
|
||||
_pthread_data_t *ptd;
|
||||
_pthread_cleanup_t *cleanup;
|
||||
|
||||
if (rt_thread_self() == NULL) return;
|
||||
|
||||
/* get pthread data from pthread_data of thread */
|
||||
ptd = (_pthread_data_t *)rt_thread_self()->pthread_data;
|
||||
RT_ASSERT(ptd != RT_NULL);
|
||||
|
||||
cleanup = (_pthread_cleanup_t *)rt_malloc(sizeof(_pthread_cleanup_t));
|
||||
if (cleanup != RT_NULL)
|
||||
{
|
||||
cleanup->cleanup_func = routine;
|
||||
cleanup->parameter = arg;
|
||||
|
||||
rt_enter_critical();
|
||||
cleanup->next = ptd->cleanup;
|
||||
ptd->cleanup = cleanup;
|
||||
rt_exit_critical();
|
||||
}
|
||||
}
|
||||
RTM_EXPORT(pthread_cleanup_push);
|
||||
|
||||
/*
|
||||
* According to IEEE Std 1003.1, 2004 Edition , following pthreads
|
||||
* interface support cancellation point:
|
||||
* mq_receive()
|
||||
* mq_send()
|
||||
* mq_timedreceive()
|
||||
* mq_timedsend()
|
||||
* msgrcv()
|
||||
* msgsnd()
|
||||
* msync()
|
||||
* pthread_cond_timedwait()
|
||||
* pthread_cond_wait()
|
||||
* pthread_join()
|
||||
* pthread_testcancel()
|
||||
* sem_timedwait()
|
||||
* sem_wait()
|
||||
*
|
||||
* A cancellation point may also occur when a thread is
|
||||
* executing the following functions:
|
||||
* pthread_rwlock_rdlock()
|
||||
* pthread_rwlock_timedrdlock()
|
||||
* pthread_rwlock_timedwrlock()
|
||||
* pthread_rwlock_wrlock()
|
||||
*
|
||||
* The pthread_cancel(), pthread_setcancelstate(), and pthread_setcanceltype()
|
||||
* functions are defined to be async-cancel safe.
|
||||
*/
|
||||
|
||||
int pthread_setcancelstate(int state, int *oldstate)
|
||||
{
|
||||
_pthread_data_t *ptd;
|
||||
|
||||
if (rt_thread_self() == NULL) return EINVAL;
|
||||
|
||||
/* get pthread data from pthread_data of thread */
|
||||
ptd = (_pthread_data_t *)rt_thread_self()->pthread_data;
|
||||
RT_ASSERT(ptd != RT_NULL);
|
||||
|
||||
if ((state == PTHREAD_CANCEL_ENABLE) || (state == PTHREAD_CANCEL_DISABLE))
|
||||
{
|
||||
if (oldstate)
|
||||
*oldstate = ptd->cancelstate;
|
||||
ptd->cancelstate = state;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_setcancelstate);
|
||||
|
||||
int pthread_setcanceltype(int type, int *oldtype)
|
||||
{
|
||||
_pthread_data_t *ptd;
|
||||
|
||||
if (rt_thread_self() == NULL) return EINVAL;
|
||||
|
||||
/* get pthread data from pthread_data of thread */
|
||||
ptd = (_pthread_data_t *)rt_thread_self()->pthread_data;
|
||||
RT_ASSERT(ptd != RT_NULL);
|
||||
|
||||
if ((type != PTHREAD_CANCEL_DEFERRED) && (type != PTHREAD_CANCEL_ASYNCHRONOUS))
|
||||
return EINVAL;
|
||||
|
||||
if (oldtype)
|
||||
*oldtype = ptd->canceltype;
|
||||
ptd->canceltype = type;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_setcanceltype);
|
||||
|
||||
void pthread_testcancel(void)
|
||||
{
|
||||
int cancel = 0;
|
||||
_pthread_data_t *ptd;
|
||||
|
||||
if (rt_thread_self() == NULL) return;
|
||||
|
||||
/* get pthread data from pthread_data of thread */
|
||||
ptd = (_pthread_data_t *)rt_thread_self()->pthread_data;
|
||||
RT_ASSERT(ptd != RT_NULL);
|
||||
|
||||
if (ptd->cancelstate == PTHREAD_CANCEL_ENABLE)
|
||||
cancel = ptd->canceled;
|
||||
if (cancel)
|
||||
pthread_exit((void *)PTHREAD_CANCELED);
|
||||
}
|
||||
RTM_EXPORT(pthread_testcancel);
|
||||
|
||||
int pthread_cancel(pthread_t thread)
|
||||
{
|
||||
_pthread_data_t *ptd;
|
||||
_pthread_cleanup_t *cleanup;
|
||||
rt_thread_t tid;
|
||||
|
||||
/* get posix thread data */
|
||||
ptd = _pthread_get_data(thread);
|
||||
if (ptd == RT_NULL)
|
||||
{
|
||||
return EINVAL;
|
||||
}
|
||||
tid = ptd->tid;
|
||||
|
||||
/* cancel self */
|
||||
if (ptd->tid == rt_thread_self())
|
||||
return 0;
|
||||
|
||||
/* set canceled */
|
||||
if (ptd->cancelstate == PTHREAD_CANCEL_ENABLE)
|
||||
{
|
||||
ptd->canceled = 1;
|
||||
if (ptd->canceltype == PTHREAD_CANCEL_ASYNCHRONOUS)
|
||||
{
|
||||
/*
|
||||
* When use pthread_cancel to exit.
|
||||
* invoke pushed cleanup
|
||||
*/
|
||||
while (ptd->cleanup != RT_NULL)
|
||||
{
|
||||
cleanup = ptd->cleanup;
|
||||
ptd->cleanup = cleanup->next;
|
||||
|
||||
cleanup->cleanup_func(cleanup->parameter);
|
||||
/* release this cleanup function */
|
||||
rt_free(cleanup);
|
||||
}
|
||||
|
||||
/* According to "detachstate" to whether or not to recycle resource immediately */
|
||||
if (ptd->attr.detachstate == PTHREAD_CREATE_JOINABLE)
|
||||
{
|
||||
/* set value */
|
||||
rt_sem_release(ptd->joinable_sem);
|
||||
}
|
||||
else
|
||||
{
|
||||
/* release pthread resource */
|
||||
_pthread_data_destroy(ptd);
|
||||
}
|
||||
|
||||
/*
|
||||
* second: detach thread.
|
||||
* this thread will be removed from scheduler list
|
||||
* and because there is a cleanup function in the
|
||||
* thread (pthread_cleanup), it will move to defunct
|
||||
* thread list and wait for handling in idle thread.
|
||||
*/
|
||||
rt_thread_detach(tid);
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_cancel);
|
||||
|
296
components/libc/posix/pthreads/pthread.h
Normal file
296
components/libc/posix/pthreads/pthread.h
Normal file
|
@ -0,0 +1,296 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2010-10-26 Bernard the first version
|
||||
*/
|
||||
|
||||
#ifndef __PTHREAD_H__
|
||||
#define __PTHREAD_H__
|
||||
|
||||
#include <rtthread.h>
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
#include <posix_types.h>
|
||||
#include <sched.h>
|
||||
|
||||
#define PTHREAD_KEY_MAX 8
|
||||
|
||||
#define PTHREAD_COND_INITIALIZER {-1}
|
||||
#define PTHREAD_RWLOCK_INITIALIZER {-1}
|
||||
#define PTHREAD_MUTEX_INITIALIZER {-1}
|
||||
|
||||
#define PTHREAD_CREATE_JOINABLE 0x00
|
||||
#define PTHREAD_CREATE_DETACHED 0x01
|
||||
|
||||
#define PTHREAD_EXPLICIT_SCHED 0
|
||||
#define PTHREAD_INHERIT_SCHED 1
|
||||
|
||||
typedef long pthread_t;
|
||||
typedef long pthread_condattr_t;
|
||||
typedef long pthread_rwlockattr_t;
|
||||
typedef long pthread_mutexattr_t;
|
||||
typedef long pthread_barrierattr_t;
|
||||
|
||||
typedef int pthread_key_t;
|
||||
typedef int pthread_once_t;
|
||||
|
||||
enum
|
||||
{
|
||||
PTHREAD_CANCEL_ASYNCHRONOUS = 0,
|
||||
PTHREAD_CANCEL_ENABLE,
|
||||
PTHREAD_CANCEL_DEFERRED,
|
||||
PTHREAD_CANCEL_DISABLE,
|
||||
PTHREAD_CANCELED
|
||||
};
|
||||
|
||||
enum
|
||||
{
|
||||
PTHREAD_MUTEX_NORMAL = 0,
|
||||
PTHREAD_MUTEX_RECURSIVE = 1,
|
||||
PTHREAD_MUTEX_ERRORCHECK = 2,
|
||||
PTHREAD_MUTEX_ERRORCHECK_NP = PTHREAD_MUTEX_ERRORCHECK,
|
||||
PTHREAD_MUTEX_RECURSIVE_NP = PTHREAD_MUTEX_RECURSIVE,
|
||||
PTHREAD_MUTEX_DEFAULT = PTHREAD_MUTEX_NORMAL
|
||||
};
|
||||
|
||||
/* init value for pthread_once_t */
|
||||
#define PTHREAD_ONCE_INIT 0
|
||||
|
||||
enum
|
||||
{
|
||||
PTHREAD_PRIO_INHERIT =0,
|
||||
PTHREAD_PRIO_NONE,
|
||||
PTHREAD_PRIO_PROTECT,
|
||||
};
|
||||
|
||||
#define PTHREAD_PROCESS_PRIVATE 0
|
||||
#define PTHREAD_PROCESS_SHARED 1
|
||||
|
||||
#define PTHREAD_SCOPE_PROCESS 0
|
||||
#define PTHREAD_SCOPE_SYSTEM 1
|
||||
|
||||
struct sched_param
|
||||
{
|
||||
int sched_priority;
|
||||
};
|
||||
|
||||
struct pthread_attr
|
||||
{
|
||||
void* stackaddr; /* stack address of thread */
|
||||
int stacksize; /* stack size of thread */
|
||||
|
||||
int inheritsched; /* Inherit parent prio/policy */
|
||||
int schedpolicy; /* scheduler policy */
|
||||
struct sched_param schedparam; /* sched parameter */
|
||||
|
||||
int detachstate; /* detach state */
|
||||
};
|
||||
typedef struct pthread_attr pthread_attr_t;
|
||||
|
||||
struct pthread_mutex
|
||||
{
|
||||
pthread_mutexattr_t attr;
|
||||
struct rt_mutex lock;
|
||||
};
|
||||
typedef struct pthread_mutex pthread_mutex_t;
|
||||
|
||||
struct pthread_cond
|
||||
{
|
||||
pthread_condattr_t attr;
|
||||
struct rt_semaphore sem;
|
||||
};
|
||||
typedef struct pthread_cond pthread_cond_t;
|
||||
|
||||
struct pthread_rwlock
|
||||
{
|
||||
pthread_rwlockattr_t attr;
|
||||
|
||||
pthread_mutex_t rw_mutex; /* basic lock on this struct */
|
||||
pthread_cond_t rw_condreaders; /* for reader threads waiting */
|
||||
pthread_cond_t rw_condwriters; /* for writer threads waiting */
|
||||
|
||||
int rw_nwaitreaders; /* the number of reader threads waiting */
|
||||
int rw_nwaitwriters; /* the number of writer threads waiting */
|
||||
int rw_refcount; /* 0: unlocked, -1: locked by writer, > 0 locked by n readers */
|
||||
};
|
||||
typedef struct pthread_rwlock pthread_rwlock_t;
|
||||
|
||||
/* spinlock implementation, (ADVANCED REALTIME THREADS)*/
|
||||
struct pthread_spinlock
|
||||
{
|
||||
int lock;
|
||||
};
|
||||
typedef struct pthread_spinlock pthread_spinlock_t;
|
||||
|
||||
struct pthread_barrier
|
||||
{
|
||||
int count;
|
||||
pthread_cond_t cond;
|
||||
pthread_mutex_t mutex;
|
||||
};
|
||||
typedef struct pthread_barrier pthread_barrier_t;
|
||||
|
||||
/* pthread thread interface */
|
||||
int pthread_attr_destroy(pthread_attr_t *attr);
|
||||
int pthread_attr_init(pthread_attr_t *attr);
|
||||
int pthread_attr_setdetachstate(pthread_attr_t *attr, int state);
|
||||
int pthread_attr_getdetachstate(pthread_attr_t const *attr, int *state);
|
||||
int pthread_attr_setschedpolicy(pthread_attr_t *attr, int policy);
|
||||
int pthread_attr_getschedpolicy(pthread_attr_t const *attr, int *policy);
|
||||
int pthread_attr_setschedparam(pthread_attr_t *attr,struct sched_param const *param);
|
||||
int pthread_attr_getschedparam(pthread_attr_t const *attr,struct sched_param *param);
|
||||
int pthread_attr_setstacksize(pthread_attr_t *attr, size_t stack_size);
|
||||
int pthread_attr_getstacksize(pthread_attr_t const *attr, size_t *stack_size);
|
||||
int pthread_attr_setstackaddr(pthread_attr_t *attr, void *stack_addr);
|
||||
int pthread_attr_getstackaddr(pthread_attr_t const *attr, void **stack_addr);
|
||||
int pthread_attr_setstack(pthread_attr_t *attr,
|
||||
void *stack_base,
|
||||
size_t stack_size);
|
||||
int pthread_attr_getstack(pthread_attr_t const *attr,
|
||||
void **stack_base,
|
||||
size_t *stack_size);
|
||||
int pthread_attr_setguardsize(pthread_attr_t *attr, size_t guard_size);
|
||||
int pthread_attr_getguardsize(pthread_attr_t const *attr, size_t *guard_size);
|
||||
int pthread_attr_setinheritsched(pthread_attr_t *attr, int inheritsched);
|
||||
int pthread_attr_getinheritsched(const pthread_attr_t *attr, int *inheritsched);
|
||||
int pthread_attr_setscope(pthread_attr_t *attr, int scope);
|
||||
int pthread_attr_getscope(pthread_attr_t const *attr, int *scope);
|
||||
int pthread_create (pthread_t *tid, const pthread_attr_t *attr,
|
||||
void *(*start) (void *), void *arg);
|
||||
|
||||
int pthread_detach (pthread_t thread);
|
||||
int pthread_join (pthread_t thread, void **value_ptr);
|
||||
|
||||
rt_inline int pthread_equal (pthread_t t1, pthread_t t2)
|
||||
{
|
||||
return t1 == t2;
|
||||
}
|
||||
|
||||
pthread_t pthread_self (void);
|
||||
|
||||
int pthread_getcpuclockid(pthread_t thread, clockid_t *clock_id);
|
||||
int pthread_getconcurrency(void);
|
||||
int pthread_setconcurrency(int new_level);
|
||||
int pthread_getschedparam(pthread_t thread, int *policy, struct sched_param *param);
|
||||
int pthread_setschedparam(pthread_t thread, int policy, const struct sched_param *param);
|
||||
int pthread_setschedprio(pthread_t thread, int prio);
|
||||
|
||||
void pthread_exit (void *value_ptr);
|
||||
int pthread_once(pthread_once_t * once_control, void (*init_routine) (void));
|
||||
|
||||
#ifdef RT_USING_SIGNALS
|
||||
int pthread_sigmask(int how, const sigset_t *set, sigset_t *oset);
|
||||
#endif
|
||||
|
||||
/* pthread cleanup */
|
||||
void pthread_cleanup_pop(int execute);
|
||||
void pthread_cleanup_push(void (*routine)(void*), void *arg);
|
||||
|
||||
/* pthread cancel */
|
||||
int pthread_cancel(pthread_t thread);
|
||||
void pthread_testcancel(void);
|
||||
int pthread_setcancelstate(int state, int *oldstate);
|
||||
int pthread_setcanceltype(int type, int *oldtype);
|
||||
|
||||
int pthread_atfork(void (*prepare)(void), void (*parent)(void), void (*child)(void));
|
||||
int pthread_kill(pthread_t thread, int sig);
|
||||
|
||||
/* pthread mutex interface */
|
||||
int pthread_mutex_init(pthread_mutex_t *mutex, const pthread_mutexattr_t *attr);
|
||||
int pthread_mutex_destroy(pthread_mutex_t *mutex);
|
||||
int pthread_mutex_lock(pthread_mutex_t *mutex);
|
||||
int pthread_mutex_unlock(pthread_mutex_t *mutex);
|
||||
int pthread_mutex_trylock(pthread_mutex_t *mutex);
|
||||
int pthread_mutex_getprioceiling(const pthread_mutex_t *mutex, int *prioceiling);
|
||||
int pthread_mutex_setprioceiling(pthread_mutex_t *mutex, int prioceiling, int *old_ceiling);
|
||||
|
||||
int pthread_mutexattr_init(pthread_mutexattr_t *attr);
|
||||
int pthread_mutexattr_destroy(pthread_mutexattr_t *attr);
|
||||
int pthread_mutexattr_gettype(const pthread_mutexattr_t *attr, int *type);
|
||||
int pthread_mutexattr_settype(pthread_mutexattr_t *attr, int type);
|
||||
int pthread_mutexattr_setpshared(pthread_mutexattr_t *attr, int pshared);
|
||||
int pthread_mutexattr_getpshared(pthread_mutexattr_t *attr, int *pshared);
|
||||
int pthread_mutexattr_getprioceiling(const pthread_mutexattr_t *attr, int *prioceiling);
|
||||
int pthread_mutexattr_setprioceiling(const pthread_mutexattr_t *attr, int prioceiling);
|
||||
int pthread_mutexattr_getprotocol(const pthread_mutexattr_t *attr, int *protocol);
|
||||
int pthread_mutexattr_setprotocol(const pthread_mutexattr_t *attr, int protocol);
|
||||
|
||||
|
||||
/* pthread condition interface */
|
||||
int pthread_condattr_destroy(pthread_condattr_t *attr);
|
||||
int pthread_condattr_init(pthread_condattr_t *attr);
|
||||
|
||||
/* ADVANCED REALTIME feature in IEEE Std 1003.1, 2004 Edition */
|
||||
int pthread_condattr_getclock(const pthread_condattr_t *attr,
|
||||
clockid_t *clock_id);
|
||||
int pthread_condattr_setclock(pthread_condattr_t *attr,
|
||||
clockid_t clock_id);
|
||||
|
||||
int pthread_cond_init(pthread_cond_t *cond, const pthread_condattr_t *attr);
|
||||
int pthread_cond_destroy(pthread_cond_t *cond);
|
||||
int pthread_cond_broadcast(pthread_cond_t *cond);
|
||||
int pthread_cond_signal(pthread_cond_t *cond);
|
||||
|
||||
int pthread_cond_wait(pthread_cond_t *cond, pthread_mutex_t *mutex);
|
||||
int pthread_cond_timedwait(pthread_cond_t *cond,
|
||||
pthread_mutex_t *mutex,
|
||||
const struct timespec *abstime);
|
||||
|
||||
/* pthread rwlock interface */
|
||||
int pthread_rwlockattr_init (pthread_rwlockattr_t *attr);
|
||||
int pthread_rwlockattr_destroy (pthread_rwlockattr_t *attr);
|
||||
int pthread_rwlockattr_getpshared (const pthread_rwlockattr_t *attr, int *pshared);
|
||||
int pthread_rwlockattr_setpshared (pthread_rwlockattr_t *attr, int pshared);
|
||||
|
||||
int pthread_rwlock_init (pthread_rwlock_t *rwlock, const pthread_rwlockattr_t *attr);
|
||||
int pthread_rwlock_destroy (pthread_rwlock_t *rwlock);
|
||||
|
||||
int pthread_rwlock_rdlock (pthread_rwlock_t *rwlock);
|
||||
int pthread_rwlock_tryrdlock (pthread_rwlock_t *rwlock);
|
||||
|
||||
int pthread_rwlock_timedrdlock (pthread_rwlock_t *rwlock, const struct timespec *abstime);
|
||||
int pthread_rwlock_timedwrlock (pthread_rwlock_t *rwlock, const struct timespec *abstime);
|
||||
|
||||
int pthread_rwlock_unlock (pthread_rwlock_t *rwlock);
|
||||
|
||||
int pthread_rwlock_wrlock (pthread_rwlock_t *rwlock);
|
||||
int pthread_rwlock_trywrlock (pthread_rwlock_t *rwlock);
|
||||
|
||||
/* pthread spinlock interface */
|
||||
int pthread_spin_init (pthread_spinlock_t *lock, int pshared);
|
||||
int pthread_spin_destroy (pthread_spinlock_t *lock);
|
||||
|
||||
int pthread_spin_lock (pthread_spinlock_t * lock);
|
||||
int pthread_spin_trylock (pthread_spinlock_t * lock);
|
||||
int pthread_spin_unlock (pthread_spinlock_t * lock);
|
||||
|
||||
/* pthread barrier interface */
|
||||
int pthread_barrierattr_destroy(pthread_barrierattr_t *attr);
|
||||
int pthread_barrierattr_init(pthread_barrierattr_t *attr);
|
||||
int pthread_barrierattr_getpshared(const pthread_barrierattr_t *attr, int *pshared);
|
||||
int pthread_barrierattr_setpshared(pthread_barrierattr_t *attr, int pshared);
|
||||
|
||||
int pthread_barrier_destroy(pthread_barrier_t *barrier);
|
||||
int pthread_barrier_init(pthread_barrier_t *barrier,
|
||||
const pthread_barrierattr_t *attr,
|
||||
unsigned count);
|
||||
|
||||
int pthread_barrier_wait(pthread_barrier_t *barrier);
|
||||
|
||||
int pthread_setspecific(pthread_key_t key, const void *value);
|
||||
void *pthread_getspecific(pthread_key_t key);
|
||||
int pthread_key_create(pthread_key_t *key, void (*destructor)(void *));
|
||||
int pthread_key_delete(pthread_key_t key);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif
|
615
components/libc/posix/pthreads/pthread_attr.c
Normal file
615
components/libc/posix/pthreads/pthread_attr.c
Normal file
|
@ -0,0 +1,615 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2023, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2010-10-26 Bernard the first version
|
||||
*/
|
||||
|
||||
#include <rtthread.h>
|
||||
#include "pthread.h"
|
||||
#include "sched.h"
|
||||
#include <string.h>
|
||||
|
||||
#define DEFAULT_STACK_SIZE 2048
|
||||
#define DEFAULT_PRIORITY (RT_THREAD_PRIORITY_MAX/2 + RT_THREAD_PRIORITY_MAX/4)
|
||||
|
||||
const pthread_attr_t pthread_default_attr =
|
||||
{
|
||||
0, /* stack base */
|
||||
DEFAULT_STACK_SIZE, /* stack size */
|
||||
|
||||
PTHREAD_INHERIT_SCHED, /* Inherit parent prio/policy */
|
||||
SCHED_FIFO, /* scheduler policy */
|
||||
{
|
||||
DEFAULT_PRIORITY, /* scheduler priority */
|
||||
},
|
||||
PTHREAD_CREATE_JOINABLE, /* detach state */
|
||||
};
|
||||
|
||||
/**
|
||||
* @brief This function will initialize thread attributes object.
|
||||
*
|
||||
* @note The pthread_attr_t type should be treated as opaque: any access to the object other
|
||||
* than via pthreads functions is nonportable and produces undefined results.
|
||||
* The resulting attribute object (possibly modified by setting individual attribute values),
|
||||
* when used by pthread_create(), defines the attributes of the thread created. A single attributes
|
||||
* object can be used in multiple simultaneous calls to pthread_create().
|
||||
*
|
||||
* @see pthread_create()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @return Upon successful completion, pthread_attr_init() return a value of 0.
|
||||
* Otherwise, it means that the event detach failed.
|
||||
*
|
||||
* @warning This function will fail if attr is null.
|
||||
*/
|
||||
int pthread_attr_init(pthread_attr_t *attr)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
*attr = pthread_default_attr;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_init);
|
||||
|
||||
/**
|
||||
* @brief This function will destroy thread attributes object.
|
||||
*
|
||||
* @note When a thread attributes object is no longer required, it should be destroyed
|
||||
* using the pthread_attr_destroy() function. Destroying a thread attributes object
|
||||
* has no effect on threads that were created using that object.
|
||||
* Once a thread attributes object has been destroyed, it can be reinitialized using pthread_attr_init().
|
||||
* Any other use of a destroyed thread attributes object has undefined results.
|
||||
*
|
||||
* @see pthread_attr_init(), pthread_attr_getdetachstate(), pthread_create()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @return Upon successful completion, pthread_attr_destroy() and shall return a value of 0;
|
||||
* Otherwise, an error number shall be returned to indicate the error.
|
||||
*
|
||||
* @warning This function will fail if attr is null.
|
||||
*/
|
||||
int pthread_attr_destroy(pthread_attr_t *attr)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
memset(attr, 0, sizeof(pthread_attr_t));
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_destroy);
|
||||
|
||||
/**
|
||||
* @brief This function set detach state attribute in thread attributes object.
|
||||
*
|
||||
* @note This function sets the detach state attribute of the thread attributes object
|
||||
* referred to by attr to the value specified in detachstate. The detach state
|
||||
* attribute determines whether a thread created using the thread attributes
|
||||
* object attr will be created in a joinable or a detached state.
|
||||
*
|
||||
* @see pthread_attr_init(), pthread_create(), pthread_detach(), pthread_join(), pthreads()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param state is attribute in the attr object.
|
||||
* attribute controls whether the thread is created in a detached state.
|
||||
* The detachstate can be ONE of the following values:
|
||||
*
|
||||
* PTHREAD_CREATE_DETACHED It causes all threads created with attr to be in the detached state.
|
||||
*
|
||||
* PTHREAD_CREATE_JOINABLE Default value, it causes all threads created with attr to be in the joinable state.
|
||||
*
|
||||
* @return Upon successful completion, pthread_attr_setdetachstate() and return a value of 0.
|
||||
* Otherwise, an error number is returned to indicate the error.
|
||||
*
|
||||
* @warning The pthread_attr_setdetachstate() function will fail if:
|
||||
* [EINVAL]
|
||||
* The value of detach state was not valid
|
||||
*/
|
||||
int pthread_attr_setdetachstate(pthread_attr_t *attr, int state)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
if (state != PTHREAD_CREATE_JOINABLE && state != PTHREAD_CREATE_DETACHED)
|
||||
return EINVAL;
|
||||
|
||||
attr->detachstate = state;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_setdetachstate);
|
||||
|
||||
/**
|
||||
* @brief This function get detach state attribute in thread attributes object.
|
||||
*
|
||||
* @note The detachstate attribute controls whether the thread is created in a detached state.
|
||||
* If the thread is created detached, then use of the ID of the newly created thread by
|
||||
* the pthread_detach() or pthread_join() function is an error.
|
||||
*
|
||||
* @see pthread_attr_destroy(), pthread_attr_getstackaddr(), pthread_attr_getstacksize(), pthread_create()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param state is attribute in the attr object.
|
||||
* attribute controls whether the thread is created in a detached state.
|
||||
* The detachstate can be ONE of the following values:
|
||||
*
|
||||
* PTHREAD_CREATE_DETACHED It causes all threads created with attr to be in the detached state.
|
||||
*
|
||||
* PTHREAD_CREATE_JOINABLE Default value, it causes all threads created with attr to be in the joinable state.
|
||||
*
|
||||
* @return Upon successful completion, pthread_attr_getdetachstate() and shall return a value of 0;
|
||||
* otherwise, an error number shall be returned to indicate the error.
|
||||
*
|
||||
* The pthread_attr_getdetachstate() function stores the value of the detachstate
|
||||
* attribute in detachstate if successful.
|
||||
*/
|
||||
int pthread_attr_getdetachstate(pthread_attr_t const *attr, int *state)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
*state = (int)attr->detachstate;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_getdetachstate);
|
||||
|
||||
/**
|
||||
* @brief This function sets schedpolicy attribute.
|
||||
*
|
||||
* @note The function function sets the scheduling policy attribute of the thread
|
||||
* attributes object referred to by attr to the value specified in policy.
|
||||
*
|
||||
* @see pthread_attr_init(), pthread_attr_setscope(), pthread_attr_setinheritsched(), pthread_attr_setschedparam(), pthread_create()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param policy is attribute in the attr object.
|
||||
* The policy can be ONE of the following values:
|
||||
*
|
||||
* SCHED_FIFO First in-first out scheduling.
|
||||
*
|
||||
* SCHED_RR Round-robin scheduling.
|
||||
*
|
||||
* SCHED_OTHER Default Linux time-sharing scheduling.
|
||||
*
|
||||
* @return On success, these functions return 0.
|
||||
*/
|
||||
int pthread_attr_setschedpolicy(pthread_attr_t *attr, int policy)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
attr->schedpolicy = policy;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_setschedpolicy);
|
||||
|
||||
/**
|
||||
* @brief This function gets schedpolicy attribute.
|
||||
*
|
||||
* @note The function gets the schedpolicy attribute in the attr argument.
|
||||
*
|
||||
* @see pthread_attr_destroy(), pthread_attr_getscope(), pthread_attr_getinheritsched(), pthread_attr_getschedparam(), pthread_create()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param policy is attribute in the attr object.
|
||||
* The policy can be ONE of the following values:
|
||||
*
|
||||
* SCHED_FIFO First in-first out scheduling.
|
||||
*
|
||||
* SCHED_RR Round-robin scheduling.
|
||||
*
|
||||
* SCHED_OTHER Default Linux time-sharing scheduling.
|
||||
*
|
||||
* @return On success, these functions return 0.
|
||||
*/
|
||||
int pthread_attr_getschedpolicy(pthread_attr_t const *attr, int *policy)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
*policy = (int)attr->schedpolicy;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_getschedpolicy);
|
||||
|
||||
/**
|
||||
* @brief This function set the scheduling parameter attributes in the attr argument.
|
||||
|
||||
* @see pthread_attr_init(), pthread_attr_setscope(), pthread_attr_setinheritsched(), pthread_attr_setschedpolicy()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param param is scheduling parameter attributes in the attr argument.
|
||||
* The contents of the param structure are defined in <pthread.h>.
|
||||
* For the SCHED_FIFO and SCHED_RR policies, the only required member of param is sched_priority.
|
||||
*
|
||||
* @return On success, these functions return 0.
|
||||
*/
|
||||
int pthread_attr_setschedparam(pthread_attr_t *attr,
|
||||
struct sched_param const *param)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
RT_ASSERT(param != RT_NULL);
|
||||
|
||||
attr->schedparam.sched_priority = param->sched_priority;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_setschedparam);
|
||||
|
||||
/**
|
||||
* @brief This function get the scheduling parameter attributes in the attr argument.
|
||||
|
||||
* @see pthread_attr_init(), pthread_attr_setscope(), pthread_attr_setinheritsched(), pthread_attr_setschedpolicy()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param param is scheduling parameter attributes in the attr argument.
|
||||
* The contents of the param structure are defined in <pthread.h>.
|
||||
* For the SCHED_FIFO and SCHED_RR policies, the only required member of param is sched_priority.
|
||||
*
|
||||
* @return On success, these functions return 0.
|
||||
*/
|
||||
int pthread_attr_getschedparam(pthread_attr_t const *attr,
|
||||
struct sched_param *param)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
RT_ASSERT(param != RT_NULL);
|
||||
|
||||
param->sched_priority = attr->schedparam.sched_priority;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_getschedparam);
|
||||
|
||||
/**
|
||||
* @brief This function set the thread creation stacksize attribute in the attr object.
|
||||
*
|
||||
* @see pthread_attr_init(), pthread_attr_setstackaddr(), pthread_attr_setdetachstate()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param stack_size is the minimum stack size (in bytes) allocated for the created threads stack.
|
||||
*
|
||||
* @return Upon successful completion, This function return a value of 0.
|
||||
*/
|
||||
int pthread_attr_setstacksize(pthread_attr_t *attr, size_t stack_size)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
attr->stacksize = stack_size;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_setstacksize);
|
||||
|
||||
/**
|
||||
* @brief This function get the thread creation stacksize attribute in the attr object.
|
||||
*
|
||||
* @see pthread_attr_init(), pthread_attr_getstackaddr(), pthread_attr_getdetachstate()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param stack_size is the minimum stack size (in bytes) allocated for the created threads stack.
|
||||
*
|
||||
* @return Upon successful completion, This function return a value of 0.
|
||||
*/
|
||||
int pthread_attr_getstacksize(pthread_attr_t const *attr, size_t *stack_size)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
*stack_size = attr->stacksize;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_getstacksize);
|
||||
|
||||
/**
|
||||
* @brief This function sets the thread creation stackaddr attribute in the attr object.
|
||||
*
|
||||
* @see pthread_attr_init(), pthread_attr_setdetachstate(), pthread_attr_setstacksize()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param The stack_addr attribute specifies the location of storage to be used for the created
|
||||
* thread's stack.
|
||||
*
|
||||
* @return Upon successful completion, This function return a value of 0.
|
||||
*/
|
||||
int pthread_attr_setstackaddr(pthread_attr_t *attr, void *stack_addr)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
return EOPNOTSUPP;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_setstackaddr);
|
||||
|
||||
/**
|
||||
* @brief This function gets the thread creation stackaddr attribute in the attr object.
|
||||
*
|
||||
* @see pthread_attr_init(), pthread_attr_setdetachstate(), pthread_attr_setstacksize()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param The stack_addr attribute specifies the location of storage to be used for the created
|
||||
* thread's stack.
|
||||
*
|
||||
* @return Upon successful completion, This function return a value of 0.
|
||||
*/
|
||||
int pthread_attr_getstackaddr(pthread_attr_t const *attr, void **stack_addr)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
return EOPNOTSUPP;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_getstackaddr);
|
||||
|
||||
/**
|
||||
* @brief This function set the thread creation stack attributes stackaddr and stacksize in the attr object.
|
||||
*
|
||||
* @note The stack attributes specify the area of storage to be used for the created thread's stack.
|
||||
* The base (lowest addressable byte) of the storage shall be stack_base, and the size of the storage
|
||||
* shall be stack_size bytes.
|
||||
* All pages within the stack described by stackaddr and stacksize shall be both readable
|
||||
* and writable by the thread.
|
||||
*
|
||||
* @see pthread_attr_destroy, pthread_attr_getdetachstate, pthread_attr_getstacksize, pthread_create
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param stack_base is the base (lowest addressable byte) of the storage.
|
||||
*
|
||||
* @param stack_size is the size of the storage.
|
||||
*
|
||||
* @return Upon successful completion, these functions shall return a value of 0;
|
||||
* otherwise, an error number shall be returned to indicate the error.
|
||||
*
|
||||
* @warning The behavior is undefined if the value specified by the attr argument to or pthread_attr_setstack()
|
||||
* does not refer to an initialized thread attributes object.
|
||||
*/
|
||||
int pthread_attr_setstack(pthread_attr_t *attr,
|
||||
void *stack_base,
|
||||
size_t stack_size)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
attr->stackaddr = stack_base;
|
||||
attr->stacksize = RT_ALIGN_DOWN(stack_size, RT_ALIGN_SIZE);
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_setstack);
|
||||
|
||||
/**
|
||||
* @brief This function shall get the thread creation stack attributes stackaddr and stacksize in the attr object.
|
||||
*
|
||||
* @note The stack attributes specify the area of storage to be used for the created thread's stack.
|
||||
* The base (lowest addressable byte) of the storage shall be stack_base, and the size of the storage
|
||||
* shall be stack_size bytes.
|
||||
* All pages within the stack described by stack_base and stack_size shall be both readable
|
||||
* and writable by the thread.
|
||||
*
|
||||
* @see pthread_attr_destroy, pthread_attr_getdetachstate, pthread_attr_getstacksize, pthread_create
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param stack_base is the base (lowest addressable byte) of the storage.
|
||||
*
|
||||
* @param stack_size is the size of the storage.
|
||||
*
|
||||
* @return Upon successful completion, these functions shall return a value of 0;
|
||||
* otherwise, an error number shall be returned to indicate the error.
|
||||
* This function shall store the stack attribute values in stack_base and stack_size if successful.
|
||||
*/
|
||||
int pthread_attr_getstack(pthread_attr_t const *attr,
|
||||
void **stack_base,
|
||||
size_t *stack_size)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
*stack_base = attr->stackaddr;
|
||||
*stack_size = attr->stacksize;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_getstack);
|
||||
|
||||
/**
|
||||
* @brief This function shall set the guardsize attribute in the attr object.
|
||||
*
|
||||
* @note The guardsize attribute controls the size of the guard area for the created thread's stack.
|
||||
* The guardsize attribute provides protection against overflow of the stack pointer.
|
||||
* If a thread's stack is created with guard protection, the implementation allocates extra
|
||||
* memory at the overflow end of the stack as a buffer against stack overflow of the stack pointer.
|
||||
* If an application overflows into this buffer an error shall result (possibly in a SIGSEGV signal
|
||||
* being delivered to the thread).
|
||||
*
|
||||
* @see <pthread.h>, <sys/mman.h>
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param guard_size is the size of the guard area for the created thread's stack.
|
||||
*
|
||||
* @return Upon successful completion, these functions shall return a value of 0;
|
||||
*
|
||||
* @warning The guardsize attribute is provided to the application for two reasons:
|
||||
*
|
||||
* 1. Overflow protection can potentially result in wasted system resources.
|
||||
* An application that creates a large number of threads, and which knows its threads
|
||||
* never overflow their stack, can save system resources by turning off guard areas.
|
||||
*
|
||||
* 2. When threads allocate large data structures on the stack, large guard areas may be
|
||||
* needed to detect stack overflow.
|
||||
*
|
||||
* The default size of the guard area is left implementation-defined since on systems
|
||||
* supporting very large page sizes, the overhead might be substantial if at least one guard
|
||||
* page is required by default.
|
||||
*/
|
||||
int pthread_attr_setguardsize(pthread_attr_t *attr, size_t guard_size)
|
||||
{
|
||||
return EOPNOTSUPP;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief This function get the guardsize attribute in the attr object.
|
||||
* This attribute shall be returned in the guard_size parameter.
|
||||
*
|
||||
* @note The guardsize attribute controls the size of the guard area for the created thread's stack.
|
||||
* The guardsize attribute provides protection against overflow of the stack pointer.
|
||||
* If a thread's stack is created with guard protection, the implementation allocates extra
|
||||
* memory at the overflow end of the stack as a buffer against stack overflow of the stack pointer.
|
||||
*
|
||||
* @see <pthread.h>, <sys/mman.h>
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param guard_size is the size of the guard area for the created thread's stack.
|
||||
*
|
||||
* @return Upon successful completion, these functions shall return a value of 0;
|
||||
*
|
||||
* @warning The guardsize attribute is provided to the application for two reasons:
|
||||
*
|
||||
* 1. Overflow protection can potentially result in wasted system resources.
|
||||
* An application that creates a large number of threads, and which knows its threads
|
||||
* never overflow their stack, can save system resources by turning off guard areas.
|
||||
*
|
||||
* 2. When threads allocate large data structures on the stack, large guard areas may be
|
||||
* needed to detect stack overflow.
|
||||
*
|
||||
* The default size of the guard area is left implementation-defined since on systems
|
||||
* supporting very large page sizes, the overhead might be substantial if at least one guard
|
||||
* page is required by default.
|
||||
*/
|
||||
int pthread_attr_getguardsize(pthread_attr_t const *attr, size_t *guard_size)
|
||||
{
|
||||
return EOPNOTSUPP;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_getguardsize);
|
||||
|
||||
/**
|
||||
* @brief This function sets inherit-scheduler attribute in thread attributes object.
|
||||
*
|
||||
* @note The function sets the inherit-scheduler attribute of the thread attributes object
|
||||
* referred to by attr to the value specified in inheritsched.
|
||||
* The inherit-scheduler attribute determines whether a thread created using the thread
|
||||
* attributes object attr will inherit its scheduling attributes from the calling thread
|
||||
* or whether it will take them from attr.
|
||||
*
|
||||
* @see pthread_attr_init(), pthread_attr_setschedpolicy(), pthread_attr_setschedparam()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param inheritsched the inheritsched attribute determines how the other scheduling attributes of the created thread are to be set:
|
||||
* The policy can be ONE of the following values:
|
||||
*
|
||||
* PTHREAD_INHERIT_SCHED Specifies that the scheduling policy and associated attributes are
|
||||
* to be inherited from the creating thread, and the scheduling attributes
|
||||
* in this attr argument are to be ignored.
|
||||
*
|
||||
* PTHREAD_EXPLICIT_SCHED Specifies that the scheduling policy and associated attributes are to be
|
||||
* set to the corresponding values from this attribute object.
|
||||
*
|
||||
* @return Upon successful completion, these functions shall return a value of 0;
|
||||
*/
|
||||
int pthread_attr_setinheritsched(pthread_attr_t *attr, int inheritsched)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
attr->inheritsched = inheritsched;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_setinheritsched);
|
||||
|
||||
/**
|
||||
* @brief This function get and set the inheritsched attribute in the attr argument.
|
||||
*
|
||||
* @note The function sets the inherit-scheduler attribute of the thread attributes object
|
||||
* referred to by attr to the value specified in inheritsched.
|
||||
* The inherit-scheduler attribute determines whether a thread created using the thread
|
||||
* attributes object attr will inherit its scheduling attributes from the calling thread
|
||||
* or whether it will take them from attr.
|
||||
*
|
||||
* @see pthread_attr_init(), pthread_attr_getschedpolicy(), pthread_attr_getschedparam()
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param inheritsched the inheritsched attribute determines how the other scheduling attributes of the created thread are to be set:
|
||||
* The inheritsched can be ONE of the following values:
|
||||
*
|
||||
* PTHREAD_INHERIT_SCHED Specifies that the scheduling policy and associated attributes are
|
||||
* to be inherited from the creating thread, and the scheduling attributes
|
||||
* in this attr argument are to be ignored.
|
||||
*
|
||||
* PTHREAD_EXPLICIT_SCHED Specifies that the scheduling policy and associated attributes are to be
|
||||
* set to the corresponding values from this attribute object.
|
||||
*
|
||||
* @return Upon successful completion, these functions shall return a value of 0;
|
||||
*/
|
||||
int pthread_attr_getinheritsched(const pthread_attr_t *attr, int *inheritsched)
|
||||
{
|
||||
RT_ASSERT(attr != RT_NULL);
|
||||
|
||||
*inheritsched = attr->inheritsched;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_getinheritsched);
|
||||
|
||||
/**
|
||||
* @brief This function set contentionscope attribute.
|
||||
*
|
||||
* @note The function are used to set the contentionscope attribute in the attr object.
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param scope is the value of contentionscope attribute.
|
||||
* The scope can be ONE of the following values:
|
||||
*
|
||||
* PTHREAD_SCOPE_SYSTEM signifying system scheduling contention scope.
|
||||
*
|
||||
* PTHREAD_SCOPE_PROCESS signifying process scheduling contention scope.
|
||||
*
|
||||
* @return Upon successful completion, these functions shall return a value of 0;
|
||||
*/
|
||||
int pthread_attr_setscope(pthread_attr_t *attr, int scope)
|
||||
{
|
||||
if (scope == PTHREAD_SCOPE_SYSTEM)
|
||||
return 0;
|
||||
if (scope == PTHREAD_SCOPE_PROCESS)
|
||||
return EOPNOTSUPP;
|
||||
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_setscope);
|
||||
|
||||
/**
|
||||
* @brief This function get contentionscope attribute.
|
||||
*
|
||||
* @note The function are used to get the contentionscope attribute in the attr object.
|
||||
*
|
||||
* @param attr is a thread attributes object.
|
||||
*
|
||||
* @param scope is the value of contentionscope attribute.
|
||||
* The scope can be ONE of the following values:
|
||||
*
|
||||
* PTHREAD_SCOPE_SYSTEM signifying system scheduling contention scope.
|
||||
*
|
||||
* PTHREAD_SCOPE_PROCESS signifying process scheduling contention scope.
|
||||
*
|
||||
* @return Upon successful completion, these functions shall return a value of 0;
|
||||
*/
|
||||
int pthread_attr_getscope(pthread_attr_t const *attr, int *scope)
|
||||
{
|
||||
return PTHREAD_SCOPE_SYSTEM;
|
||||
}
|
||||
RTM_EXPORT(pthread_attr_getscope);
|
112
components/libc/posix/pthreads/pthread_barrier.c
Normal file
112
components/libc/posix/pthreads/pthread_barrier.c
Normal file
|
@ -0,0 +1,112 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2010-10-26 Bernard the first version
|
||||
*/
|
||||
|
||||
#include <pthread.h>
|
||||
|
||||
int pthread_barrierattr_destroy(pthread_barrierattr_t *attr)
|
||||
{
|
||||
if (!attr)
|
||||
return EINVAL;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_barrierattr_destroy);
|
||||
|
||||
int pthread_barrierattr_init(pthread_barrierattr_t *attr)
|
||||
{
|
||||
if (!attr)
|
||||
return EINVAL;
|
||||
*attr = PTHREAD_PROCESS_PRIVATE;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_barrierattr_init);
|
||||
|
||||
int pthread_barrierattr_getpshared(const pthread_barrierattr_t *attr,
|
||||
int *pshared)
|
||||
{
|
||||
if (!attr)
|
||||
return EINVAL;
|
||||
*pshared = (int)*attr;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_barrierattr_getpshared);
|
||||
|
||||
int pthread_barrierattr_setpshared(pthread_barrierattr_t *attr, int pshared)
|
||||
{
|
||||
if (!attr)
|
||||
return EINVAL;
|
||||
if (pshared == PTHREAD_PROCESS_PRIVATE)
|
||||
attr = PTHREAD_PROCESS_PRIVATE;
|
||||
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_barrierattr_setpshared);
|
||||
|
||||
int pthread_barrier_destroy(pthread_barrier_t *barrier)
|
||||
{
|
||||
rt_err_t result;
|
||||
|
||||
if (!barrier)
|
||||
return EINVAL;
|
||||
|
||||
result = pthread_cond_destroy(&(barrier->cond));
|
||||
|
||||
return result;
|
||||
}
|
||||
RTM_EXPORT(pthread_barrier_destroy);
|
||||
|
||||
int pthread_barrier_init(pthread_barrier_t *barrier,
|
||||
const pthread_barrierattr_t *attr,
|
||||
unsigned count)
|
||||
{
|
||||
if (!barrier)
|
||||
return EINVAL;
|
||||
if (attr && (*attr != PTHREAD_PROCESS_PRIVATE))
|
||||
return EINVAL;
|
||||
if (count == 0)
|
||||
return EINVAL;
|
||||
|
||||
barrier->count = count;
|
||||
pthread_cond_init(&(barrier->cond), NULL);
|
||||
pthread_mutex_init(&(barrier->mutex), NULL);
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_barrier_init);
|
||||
|
||||
int pthread_barrier_wait(pthread_barrier_t *barrier)
|
||||
{
|
||||
rt_err_t result;
|
||||
if (!barrier)
|
||||
return EINVAL;
|
||||
|
||||
result = pthread_mutex_lock(&(barrier->mutex));
|
||||
if (result != 0)
|
||||
return EINVAL;
|
||||
|
||||
if (barrier->count == 0)
|
||||
result = EINVAL;
|
||||
else
|
||||
{
|
||||
barrier->count -= 1;
|
||||
if (barrier->count == 0) /* broadcast condition */
|
||||
pthread_cond_broadcast(&(barrier->cond));
|
||||
else
|
||||
pthread_cond_wait(&(barrier->cond), &(barrier->mutex));
|
||||
}
|
||||
|
||||
pthread_mutex_unlock(&(barrier->mutex));
|
||||
|
||||
return result;
|
||||
}
|
||||
RTM_EXPORT(pthread_barrier_wait);
|
||||
|
372
components/libc/posix/pthreads/pthread_cond.c
Normal file
372
components/libc/posix/pthreads/pthread_cond.c
Normal file
|
@ -0,0 +1,372 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2010-10-26 Bernard the first version
|
||||
* 2022-06-27 xiangxistu use atomic operation to protect pthread conditional variable
|
||||
*/
|
||||
|
||||
#include <rthw.h>
|
||||
#include <pthread.h>
|
||||
#include "pthread_internal.h"
|
||||
|
||||
int pthread_condattr_destroy(pthread_condattr_t *attr)
|
||||
{
|
||||
if (!attr)
|
||||
return EINVAL;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_condattr_destroy);
|
||||
|
||||
int pthread_condattr_init(pthread_condattr_t *attr)
|
||||
{
|
||||
if (!attr)
|
||||
return EINVAL;
|
||||
*attr = PTHREAD_PROCESS_PRIVATE;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_condattr_init);
|
||||
|
||||
int pthread_condattr_getclock(const pthread_condattr_t *attr,
|
||||
clockid_t *clock_id)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_condattr_getclock);
|
||||
|
||||
int pthread_condattr_setclock(pthread_condattr_t *attr,
|
||||
clockid_t clock_id)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_condattr_setclock);
|
||||
|
||||
int pthread_condattr_getpshared(const pthread_condattr_t *attr, int *pshared)
|
||||
{
|
||||
if (!attr || !pshared)
|
||||
return EINVAL;
|
||||
|
||||
*pshared = PTHREAD_PROCESS_PRIVATE;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_condattr_getpshared);
|
||||
|
||||
int pthread_condattr_setpshared(pthread_condattr_t *attr, int pshared)
|
||||
{
|
||||
if ((pshared != PTHREAD_PROCESS_PRIVATE) &&
|
||||
(pshared != PTHREAD_PROCESS_SHARED))
|
||||
{
|
||||
return EINVAL;
|
||||
}
|
||||
|
||||
if (pshared != PTHREAD_PROCESS_PRIVATE)
|
||||
return ENOSYS;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_condattr_setpshared);
|
||||
|
||||
int pthread_cond_init(pthread_cond_t *cond, const pthread_condattr_t *attr)
|
||||
{
|
||||
rt_err_t result;
|
||||
char cond_name[RT_NAME_MAX];
|
||||
static rt_uint16_t cond_num = 0;
|
||||
|
||||
/* parameter check */
|
||||
if (cond == RT_NULL)
|
||||
return EINVAL;
|
||||
if ((attr != RT_NULL) && (*attr != PTHREAD_PROCESS_PRIVATE))
|
||||
return EINVAL;
|
||||
|
||||
rt_snprintf(cond_name, sizeof(cond_name), "cond%02d", cond_num++);
|
||||
|
||||
/* use default value */
|
||||
if (attr == RT_NULL)
|
||||
{
|
||||
cond->attr = PTHREAD_PROCESS_PRIVATE;
|
||||
}
|
||||
else
|
||||
{
|
||||
cond->attr = *attr;
|
||||
}
|
||||
|
||||
result = rt_sem_init(&cond->sem, cond_name, 0, RT_IPC_FLAG_FIFO);
|
||||
if (result != RT_EOK)
|
||||
{
|
||||
return EINVAL;
|
||||
}
|
||||
|
||||
/* detach the object from system object container */
|
||||
rt_object_detach(&(cond->sem.parent.parent));
|
||||
cond->sem.parent.parent.type = RT_Object_Class_Semaphore;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_cond_init);
|
||||
|
||||
int pthread_cond_destroy(pthread_cond_t *cond)
|
||||
{
|
||||
rt_err_t result;
|
||||
if (cond == RT_NULL)
|
||||
{
|
||||
return EINVAL;
|
||||
}
|
||||
/* which is not initialized */
|
||||
if (cond->attr == -1)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
if (!rt_list_isempty(&cond->sem.parent.suspend_thread))
|
||||
{
|
||||
return EBUSY;
|
||||
}
|
||||
__retry:
|
||||
result = rt_sem_trytake(&(cond->sem));
|
||||
if (result == EBUSY)
|
||||
{
|
||||
pthread_cond_broadcast(cond);
|
||||
goto __retry;
|
||||
}
|
||||
|
||||
/* clean condition */
|
||||
rt_memset(cond, 0, sizeof(pthread_cond_t));
|
||||
cond->attr = -1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_cond_destroy);
|
||||
|
||||
int pthread_cond_broadcast(pthread_cond_t *cond)
|
||||
{
|
||||
rt_err_t result;
|
||||
|
||||
if (cond == RT_NULL)
|
||||
return EINVAL;
|
||||
if (cond->attr == -1)
|
||||
pthread_cond_init(cond, RT_NULL);
|
||||
|
||||
while (1)
|
||||
{
|
||||
/* try to take condition semaphore */
|
||||
result = rt_sem_trytake(&(cond->sem));
|
||||
if (result == -RT_ETIMEOUT)
|
||||
{
|
||||
/* it's timeout, release this semaphore */
|
||||
rt_sem_release(&(cond->sem));
|
||||
}
|
||||
else if (result == RT_EOK)
|
||||
{
|
||||
/* has taken this semaphore, release it */
|
||||
rt_sem_release(&(cond->sem));
|
||||
break;
|
||||
}
|
||||
else
|
||||
{
|
||||
return EINVAL;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_cond_broadcast);
|
||||
|
||||
int pthread_cond_signal(pthread_cond_t *cond)
|
||||
{
|
||||
rt_base_t temp;
|
||||
rt_err_t result;
|
||||
|
||||
if (cond == RT_NULL)
|
||||
return EINVAL;
|
||||
if (cond->attr == -1)
|
||||
pthread_cond_init(cond, RT_NULL);
|
||||
|
||||
/* disable interrupt */
|
||||
temp = rt_hw_interrupt_disable();
|
||||
if (rt_list_isempty(&cond->sem.parent.suspend_thread))
|
||||
{
|
||||
/* enable interrupt */
|
||||
rt_hw_interrupt_enable(temp);
|
||||
return 0;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* enable interrupt */
|
||||
rt_hw_interrupt_enable(temp);
|
||||
result = rt_sem_release(&(cond->sem));
|
||||
if (result == RT_EOK)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
RTM_EXPORT(pthread_cond_signal);
|
||||
|
||||
rt_err_t _pthread_cond_timedwait(pthread_cond_t *cond,
|
||||
pthread_mutex_t *mutex,
|
||||
rt_int32_t timeout)
|
||||
{
|
||||
rt_err_t result = RT_EOK;
|
||||
rt_sem_t sem;
|
||||
rt_int32_t time;
|
||||
|
||||
sem = &(cond->sem);
|
||||
if (sem == RT_NULL)
|
||||
{
|
||||
return -RT_ERROR;
|
||||
}
|
||||
time = timeout;
|
||||
|
||||
if (!cond || !mutex)
|
||||
{
|
||||
return -RT_ERROR;
|
||||
}
|
||||
/* check whether initialized */
|
||||
if (cond->attr == -1)
|
||||
{
|
||||
pthread_cond_init(cond, RT_NULL);
|
||||
}
|
||||
|
||||
/* The mutex was not owned by the current thread at the time of the call. */
|
||||
if (mutex->lock.owner != rt_thread_self())
|
||||
{
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
{
|
||||
register rt_base_t temp;
|
||||
struct rt_thread *thread;
|
||||
|
||||
/* parameter check */
|
||||
RT_ASSERT(sem != RT_NULL);
|
||||
RT_ASSERT(rt_object_get_type(&sem->parent.parent) == RT_Object_Class_Semaphore);
|
||||
|
||||
/* disable interrupt */
|
||||
temp = rt_hw_interrupt_disable();
|
||||
|
||||
if (sem->value > 0)
|
||||
{
|
||||
/* semaphore is available */
|
||||
sem->value--;
|
||||
|
||||
/* enable interrupt */
|
||||
rt_hw_interrupt_enable(temp);
|
||||
}
|
||||
else
|
||||
{
|
||||
/* no waiting, return with timeout */
|
||||
if (time == 0)
|
||||
{
|
||||
rt_hw_interrupt_enable(temp);
|
||||
|
||||
return -RT_ETIMEOUT;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* current context checking */
|
||||
RT_DEBUG_IN_THREAD_CONTEXT;
|
||||
|
||||
/* semaphore is unavailable, push to suspend list */
|
||||
/* get current thread */
|
||||
thread = rt_thread_self();
|
||||
|
||||
/* reset thread error number */
|
||||
thread->error = RT_EOK;
|
||||
|
||||
/* suspend thread */
|
||||
rt_thread_suspend(thread);
|
||||
|
||||
/* Only support FIFO */
|
||||
rt_list_insert_before(&(sem->parent.suspend_thread), &(thread->tlist));
|
||||
|
||||
/**
|
||||
rt_ipc_list_suspend(&(sem->parent.suspend_thread),
|
||||
thread,
|
||||
sem->parent.parent.flag);
|
||||
*/
|
||||
|
||||
/* has waiting time, start thread timer */
|
||||
if (time > 0)
|
||||
{
|
||||
/* reset the timeout of thread timer and start it */
|
||||
rt_timer_control(&(thread->thread_timer),
|
||||
RT_TIMER_CTRL_SET_TIME,
|
||||
&time);
|
||||
rt_timer_start(&(thread->thread_timer));
|
||||
}
|
||||
|
||||
/* to avoid the lost of singal< cond->sem > */
|
||||
if (pthread_mutex_unlock(mutex) != 0)
|
||||
{
|
||||
return -RT_ERROR;
|
||||
}
|
||||
|
||||
/* enable interrupt */
|
||||
rt_hw_interrupt_enable(temp);
|
||||
|
||||
/* do schedule */
|
||||
rt_schedule();
|
||||
|
||||
result = thread->error;
|
||||
|
||||
/* lock mutex again */
|
||||
pthread_mutex_lock(mutex);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return result;
|
||||
}
|
||||
RTM_EXPORT(_pthread_cond_timedwait);
|
||||
|
||||
int pthread_cond_wait(pthread_cond_t *cond, pthread_mutex_t *mutex)
|
||||
{
|
||||
rt_err_t result;
|
||||
|
||||
__retry:
|
||||
result = _pthread_cond_timedwait(cond, mutex, RT_WAITING_FOREVER);
|
||||
if (result == RT_EOK)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
else if (result == -RT_EINTR)
|
||||
{
|
||||
/* https://pubs.opengroup.org/onlinepubs/9699919799/functions/pthread_cond_wait.html
|
||||
* These functions shall not return an error code of [EINTR].
|
||||
*/
|
||||
goto __retry;
|
||||
}
|
||||
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_cond_wait);
|
||||
|
||||
int pthread_cond_timedwait(pthread_cond_t *cond,
|
||||
pthread_mutex_t *mutex,
|
||||
const struct timespec *abstime)
|
||||
{
|
||||
int timeout;
|
||||
rt_err_t result;
|
||||
|
||||
timeout = rt_timespec_to_tick(abstime);
|
||||
result = _pthread_cond_timedwait(cond, mutex, timeout);
|
||||
if (result == RT_EOK)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
if (result == -RT_ETIMEOUT)
|
||||
{
|
||||
return ETIMEDOUT;
|
||||
}
|
||||
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_cond_timedwait);
|
66
components/libc/posix/pthreads/pthread_internal.h
Normal file
66
components/libc/posix/pthreads/pthread_internal.h
Normal file
|
@ -0,0 +1,66 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2010-10-26 Bernard the first version
|
||||
*/
|
||||
|
||||
#ifndef __PTHREAD_INTERNAL_H__
|
||||
#define __PTHREAD_INTERNAL_H__
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <pthread.h>
|
||||
#include <sys/time.h>
|
||||
|
||||
struct _pthread_cleanup
|
||||
{
|
||||
void (*cleanup_func)(void *parameter);
|
||||
void *parameter;
|
||||
|
||||
struct _pthread_cleanup *next;
|
||||
};
|
||||
typedef struct _pthread_cleanup _pthread_cleanup_t;
|
||||
|
||||
struct _pthread_key_data
|
||||
{
|
||||
int is_used;
|
||||
void (*destructor)(void *parameter);
|
||||
};
|
||||
typedef struct _pthread_key_data _pthread_key_data_t;
|
||||
|
||||
#ifndef PTHREAD_NUM_MAX
|
||||
#define PTHREAD_NUM_MAX 32
|
||||
#endif
|
||||
|
||||
#define PTHREAD_MAGIC 0x70746873
|
||||
struct _pthread_data
|
||||
{
|
||||
rt_uint32_t magic;
|
||||
pthread_attr_t attr;
|
||||
rt_thread_t tid;
|
||||
|
||||
void* (*thread_entry)(void *parameter);
|
||||
void *thread_parameter;
|
||||
|
||||
/* return value */
|
||||
void *return_value;
|
||||
|
||||
/* semaphore for joinable thread */
|
||||
rt_sem_t joinable_sem;
|
||||
|
||||
/* cancel state and type */
|
||||
rt_uint8_t cancelstate;
|
||||
volatile rt_uint8_t canceltype;
|
||||
volatile rt_uint8_t canceled;
|
||||
|
||||
_pthread_cleanup_t *cleanup;
|
||||
void** tls; /* thread-local storage area */
|
||||
};
|
||||
typedef struct _pthread_data _pthread_data_t;
|
||||
|
||||
_pthread_data_t *_pthread_get_data(pthread_t thread);
|
||||
|
||||
#endif
|
290
components/libc/posix/pthreads/pthread_mutex.c
Normal file
290
components/libc/posix/pthreads/pthread_mutex.c
Normal file
|
@ -0,0 +1,290 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2010-10-26 Bernard the first version
|
||||
*/
|
||||
|
||||
#include <rtthread.h>
|
||||
#include "pthread.h"
|
||||
|
||||
#define MUTEXATTR_SHARED_MASK 0x0010
|
||||
#define MUTEXATTR_TYPE_MASK 0x000f
|
||||
|
||||
const pthread_mutexattr_t pthread_default_mutexattr = PTHREAD_PROCESS_PRIVATE;
|
||||
|
||||
int pthread_mutexattr_init(pthread_mutexattr_t *attr)
|
||||
{
|
||||
if (attr)
|
||||
{
|
||||
*attr = pthread_default_mutexattr;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutexattr_init);
|
||||
|
||||
int pthread_mutexattr_destroy(pthread_mutexattr_t *attr)
|
||||
{
|
||||
if (attr)
|
||||
{
|
||||
*attr = -1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutexattr_destroy);
|
||||
|
||||
int pthread_mutexattr_gettype(const pthread_mutexattr_t *attr, int *type)
|
||||
{
|
||||
if (attr && type)
|
||||
{
|
||||
int atype = (*attr & MUTEXATTR_TYPE_MASK);
|
||||
|
||||
if (atype >= PTHREAD_MUTEX_NORMAL && atype <= PTHREAD_MUTEX_ERRORCHECK)
|
||||
{
|
||||
*type = atype;
|
||||
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutexattr_gettype);
|
||||
|
||||
int pthread_mutexattr_settype(pthread_mutexattr_t *attr, int type)
|
||||
{
|
||||
if (attr && type >= PTHREAD_MUTEX_NORMAL && type <= PTHREAD_MUTEX_ERRORCHECK)
|
||||
{
|
||||
*attr = (*attr & ~MUTEXATTR_TYPE_MASK) | type;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutexattr_settype);
|
||||
|
||||
int pthread_mutexattr_setpshared(pthread_mutexattr_t *attr, int pshared)
|
||||
{
|
||||
if (!attr)
|
||||
return EINVAL;
|
||||
|
||||
switch (pshared)
|
||||
{
|
||||
case PTHREAD_PROCESS_PRIVATE:
|
||||
*attr &= ~MUTEXATTR_SHARED_MASK;
|
||||
return 0;
|
||||
|
||||
case PTHREAD_PROCESS_SHARED:
|
||||
*attr |= MUTEXATTR_SHARED_MASK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutexattr_setpshared);
|
||||
|
||||
int pthread_mutexattr_getpshared(pthread_mutexattr_t *attr, int *pshared)
|
||||
{
|
||||
if (!attr || !pshared)
|
||||
return EINVAL;
|
||||
|
||||
*pshared = (*attr & MUTEXATTR_SHARED_MASK) ? PTHREAD_PROCESS_SHARED
|
||||
: PTHREAD_PROCESS_PRIVATE;
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutexattr_getpshared);
|
||||
|
||||
int pthread_mutex_init(pthread_mutex_t *mutex, const pthread_mutexattr_t *attr)
|
||||
{
|
||||
rt_err_t result;
|
||||
char name[RT_NAME_MAX];
|
||||
static rt_uint16_t pthread_mutex_number = 0;
|
||||
|
||||
if (!mutex)
|
||||
return EINVAL;
|
||||
|
||||
/* build mutex name */
|
||||
rt_snprintf(name, sizeof(name), "pmtx%02d", pthread_mutex_number ++);
|
||||
if (attr == RT_NULL)
|
||||
mutex->attr = pthread_default_mutexattr;
|
||||
else
|
||||
mutex->attr = *attr;
|
||||
|
||||
/* init mutex lock */
|
||||
result = rt_mutex_init(&(mutex->lock), name, RT_IPC_FLAG_PRIO);
|
||||
if (result != RT_EOK)
|
||||
return EINVAL;
|
||||
|
||||
/* detach the object from system object container */
|
||||
rt_object_detach(&(mutex->lock.parent.parent));
|
||||
mutex->lock.parent.parent.type = RT_Object_Class_Mutex;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutex_init);
|
||||
|
||||
int pthread_mutex_destroy(pthread_mutex_t *mutex)
|
||||
{
|
||||
if (!mutex || mutex->attr == -1)
|
||||
return EINVAL;
|
||||
|
||||
/* it's busy */
|
||||
if (mutex->lock.owner != RT_NULL)
|
||||
return EBUSY;
|
||||
|
||||
rt_memset(mutex, 0, sizeof(pthread_mutex_t));
|
||||
mutex->attr = -1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutex_destroy);
|
||||
|
||||
int pthread_mutex_lock(pthread_mutex_t *mutex)
|
||||
{
|
||||
int mtype;
|
||||
rt_err_t result;
|
||||
|
||||
if (!mutex)
|
||||
return EINVAL;
|
||||
|
||||
if (mutex->attr == -1)
|
||||
{
|
||||
/* init mutex */
|
||||
pthread_mutex_init(mutex, RT_NULL);
|
||||
}
|
||||
|
||||
mtype = mutex->attr & MUTEXATTR_TYPE_MASK;
|
||||
rt_enter_critical();
|
||||
if (mutex->lock.owner == rt_thread_self() &&
|
||||
mtype != PTHREAD_MUTEX_RECURSIVE)
|
||||
{
|
||||
rt_exit_critical();
|
||||
|
||||
return EDEADLK;
|
||||
}
|
||||
rt_exit_critical();
|
||||
|
||||
result = rt_mutex_take(&(mutex->lock), RT_WAITING_FOREVER);
|
||||
if (result == RT_EOK)
|
||||
return 0;
|
||||
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutex_lock);
|
||||
|
||||
int pthread_mutex_unlock(pthread_mutex_t *mutex)
|
||||
{
|
||||
rt_err_t result;
|
||||
|
||||
if (!mutex)
|
||||
return EINVAL;
|
||||
if (mutex->attr == -1)
|
||||
{
|
||||
/* init mutex */
|
||||
pthread_mutex_init(mutex, RT_NULL);
|
||||
}
|
||||
|
||||
if (mutex->lock.owner != rt_thread_self())
|
||||
{
|
||||
int mtype;
|
||||
mtype = mutex->attr & MUTEXATTR_TYPE_MASK;
|
||||
|
||||
/* error check, return EPERM */
|
||||
if (mtype == PTHREAD_MUTEX_ERRORCHECK)
|
||||
return EPERM;
|
||||
|
||||
/* no thread waiting on this mutex */
|
||||
if (mutex->lock.owner == RT_NULL)
|
||||
return 0;
|
||||
}
|
||||
|
||||
result = rt_mutex_release(&(mutex->lock));
|
||||
if (result == RT_EOK)
|
||||
return 0;
|
||||
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutex_unlock);
|
||||
|
||||
int pthread_mutex_trylock(pthread_mutex_t *mutex)
|
||||
{
|
||||
rt_err_t result;
|
||||
int mtype;
|
||||
|
||||
if (!mutex)
|
||||
return EINVAL;
|
||||
if (mutex->attr == -1)
|
||||
{
|
||||
/* init mutex */
|
||||
pthread_mutex_init(mutex, RT_NULL);
|
||||
}
|
||||
|
||||
mtype = mutex->attr & MUTEXATTR_TYPE_MASK;
|
||||
rt_enter_critical();
|
||||
if (mutex->lock.owner == rt_thread_self() &&
|
||||
mtype != PTHREAD_MUTEX_RECURSIVE)
|
||||
{
|
||||
rt_exit_critical();
|
||||
|
||||
return EDEADLK;
|
||||
}
|
||||
rt_exit_critical();
|
||||
|
||||
result = rt_mutex_take(&(mutex->lock), 0);
|
||||
if (result == RT_EOK) return 0;
|
||||
|
||||
return EBUSY;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutex_trylock);
|
||||
|
||||
int pthread_mutexattr_getprioceiling(const pthread_mutexattr_t *attr, int *prioceiling)
|
||||
{
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutexattr_getprioceiling);
|
||||
|
||||
int pthread_mutexattr_setprioceiling(const pthread_mutexattr_t *attr, int prioceiling)
|
||||
{
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutexattr_setprioceiling);
|
||||
|
||||
int pthread_mutexattr_getprotocol(const pthread_mutexattr_t *attr, int *protocol)
|
||||
{
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutexattr_getprotocol);
|
||||
|
||||
int pthread_mutexattr_setprotocol(const pthread_mutexattr_t *attr, int protocol)
|
||||
{
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_mutexattr_setprotocol);
|
||||
|
||||
int pthread_mutex_getprioceiling(const pthread_mutex_t *mutex, int *prioceiling)
|
||||
{
|
||||
return pthread_mutexattr_getprioceiling(&mutex->attr, prioceiling);
|
||||
}
|
||||
RTM_EXPORT(pthread_mutex_getprioceiling);
|
||||
|
||||
int pthread_mutex_setprioceiling(pthread_mutex_t *mutex, int prioceiling, int *old_ceiling)
|
||||
{
|
||||
*old_ceiling = pthread_mutexattr_getprioceiling(&mutex->attr, old_ceiling);
|
||||
if(*old_ceiling != 0)
|
||||
{
|
||||
return EINVAL;
|
||||
}
|
||||
|
||||
return pthread_mutexattr_setprioceiling(&mutex->attr, prioceiling);
|
||||
}
|
||||
RTM_EXPORT(pthread_mutex_setprioceiling);
|
340
components/libc/posix/pthreads/pthread_rwlock.c
Normal file
340
components/libc/posix/pthreads/pthread_rwlock.c
Normal file
|
@ -0,0 +1,340 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2010-10-26 Bernard the first version
|
||||
*/
|
||||
|
||||
#include <pthread.h>
|
||||
|
||||
int pthread_rwlockattr_init(pthread_rwlockattr_t *attr)
|
||||
{
|
||||
if (!attr)
|
||||
return EINVAL;
|
||||
*attr = PTHREAD_PROCESS_PRIVATE;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_rwlockattr_init);
|
||||
|
||||
int pthread_rwlockattr_destroy(pthread_rwlockattr_t *attr)
|
||||
{
|
||||
if (!attr)
|
||||
return EINVAL;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_rwlockattr_destroy);
|
||||
|
||||
int pthread_rwlockattr_getpshared(const pthread_rwlockattr_t *attr,
|
||||
int *pshared)
|
||||
{
|
||||
if (!attr || !pshared)
|
||||
return EINVAL;
|
||||
|
||||
*pshared = PTHREAD_PROCESS_PRIVATE;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_rwlockattr_getpshared);
|
||||
|
||||
int pthread_rwlockattr_setpshared(pthread_rwlockattr_t *attr, int pshared)
|
||||
{
|
||||
if (!attr || pshared != PTHREAD_PROCESS_PRIVATE)
|
||||
return EINVAL;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_rwlockattr_setpshared);
|
||||
|
||||
int pthread_rwlock_init(pthread_rwlock_t *rwlock,
|
||||
const pthread_rwlockattr_t *attr)
|
||||
{
|
||||
if (!rwlock)
|
||||
return EINVAL;
|
||||
|
||||
rwlock->attr = PTHREAD_PROCESS_PRIVATE;
|
||||
pthread_mutex_init(&(rwlock->rw_mutex), NULL);
|
||||
pthread_cond_init(&(rwlock->rw_condreaders), NULL);
|
||||
pthread_cond_init(&(rwlock->rw_condwriters), NULL);
|
||||
|
||||
rwlock->rw_nwaitwriters = 0;
|
||||
rwlock->rw_nwaitreaders = 0;
|
||||
rwlock->rw_refcount = 0;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_rwlock_init);
|
||||
|
||||
int pthread_rwlock_destroy (pthread_rwlock_t *rwlock)
|
||||
{
|
||||
int result;
|
||||
|
||||
if (!rwlock)
|
||||
return EINVAL;
|
||||
if (rwlock->attr == -1)
|
||||
return 0; /* rwlock is not initialized */
|
||||
|
||||
if ( (result = pthread_mutex_lock(&rwlock->rw_mutex)) != 0)
|
||||
return(result);
|
||||
|
||||
if (rwlock->rw_refcount != 0 ||
|
||||
rwlock->rw_nwaitreaders != 0 ||
|
||||
rwlock->rw_nwaitwriters != 0)
|
||||
{
|
||||
result = EBUSY;
|
||||
|
||||
return result;
|
||||
}
|
||||
else
|
||||
{
|
||||
/* check whether busy */
|
||||
result = rt_sem_trytake(&(rwlock->rw_condreaders.sem));
|
||||
if (result == RT_EOK)
|
||||
{
|
||||
result = rt_sem_trytake(&(rwlock->rw_condwriters.sem));
|
||||
if (result == RT_EOK)
|
||||
{
|
||||
rt_sem_release(&(rwlock->rw_condreaders.sem));
|
||||
rt_sem_release(&(rwlock->rw_condwriters.sem));
|
||||
|
||||
pthread_cond_destroy(&rwlock->rw_condreaders);
|
||||
pthread_cond_destroy(&rwlock->rw_condwriters);
|
||||
}
|
||||
else
|
||||
{
|
||||
rt_sem_release(&(rwlock->rw_condreaders.sem));
|
||||
result = EBUSY;
|
||||
}
|
||||
}
|
||||
else
|
||||
result = EBUSY;
|
||||
}
|
||||
|
||||
pthread_mutex_unlock(&rwlock->rw_mutex);
|
||||
if (result == 0)
|
||||
pthread_mutex_destroy(&rwlock->rw_mutex);
|
||||
|
||||
return result;
|
||||
}
|
||||
RTM_EXPORT(pthread_rwlock_destroy);
|
||||
|
||||
int pthread_rwlock_rdlock(pthread_rwlock_t *rwlock)
|
||||
{
|
||||
int result;
|
||||
|
||||
if (!rwlock)
|
||||
return EINVAL;
|
||||
if (rwlock->attr == -1)
|
||||
pthread_rwlock_init(rwlock, NULL);
|
||||
|
||||
if ((result = pthread_mutex_lock(&rwlock->rw_mutex)) != 0)
|
||||
return(result);
|
||||
|
||||
/* give preference to waiting writers */
|
||||
while (rwlock->rw_refcount < 0 || rwlock->rw_nwaitwriters > 0)
|
||||
{
|
||||
rwlock->rw_nwaitreaders++;
|
||||
/* rw_mutex will be released when waiting for rw_condreaders */
|
||||
result = pthread_cond_wait(&rwlock->rw_condreaders, &rwlock->rw_mutex);
|
||||
/* rw_mutex should have been taken again when returned from waiting */
|
||||
rwlock->rw_nwaitreaders--;
|
||||
if (result != 0) /* wait error */
|
||||
break;
|
||||
}
|
||||
|
||||
/* another reader has a read lock */
|
||||
if (result == 0)
|
||||
rwlock->rw_refcount++;
|
||||
|
||||
pthread_mutex_unlock(&rwlock->rw_mutex);
|
||||
|
||||
return (result);
|
||||
}
|
||||
RTM_EXPORT(pthread_rwlock_rdlock);
|
||||
|
||||
int pthread_rwlock_tryrdlock(pthread_rwlock_t *rwlock)
|
||||
{
|
||||
int result;
|
||||
|
||||
if (!rwlock)
|
||||
return EINVAL;
|
||||
if (rwlock->attr == -1)
|
||||
pthread_rwlock_init(rwlock, NULL);
|
||||
|
||||
if ((result = pthread_mutex_lock(&rwlock->rw_mutex)) != 0)
|
||||
return(result);
|
||||
|
||||
if (rwlock->rw_refcount < 0 || rwlock->rw_nwaitwriters > 0)
|
||||
result = EBUSY; /* held by a writer or waiting writers */
|
||||
else
|
||||
rwlock->rw_refcount++; /* increment count of reader locks */
|
||||
|
||||
pthread_mutex_unlock(&rwlock->rw_mutex);
|
||||
|
||||
return(result);
|
||||
}
|
||||
RTM_EXPORT(pthread_rwlock_tryrdlock);
|
||||
|
||||
int pthread_rwlock_timedrdlock(pthread_rwlock_t *rwlock,
|
||||
const struct timespec *abstime)
|
||||
{
|
||||
int result;
|
||||
|
||||
if (!rwlock)
|
||||
return EINVAL;
|
||||
if (rwlock->attr == -1)
|
||||
pthread_rwlock_init(rwlock, NULL);
|
||||
|
||||
if ( (result = pthread_mutex_lock(&rwlock->rw_mutex)) != 0)
|
||||
return(result);
|
||||
|
||||
/* give preference to waiting writers */
|
||||
while (rwlock->rw_refcount < 0 || rwlock->rw_nwaitwriters > 0)
|
||||
{
|
||||
rwlock->rw_nwaitreaders++;
|
||||
/* rw_mutex will be released when waiting for rw_condreaders */
|
||||
result = pthread_cond_timedwait(&rwlock->rw_condreaders, &rwlock->rw_mutex, abstime);
|
||||
/* rw_mutex should have been taken again when returned from waiting */
|
||||
rwlock->rw_nwaitreaders--;
|
||||
if (result != 0)
|
||||
break;
|
||||
}
|
||||
|
||||
/* another reader has a read lock */
|
||||
if (result == 0)
|
||||
rwlock->rw_refcount++;
|
||||
|
||||
pthread_mutex_unlock(&rwlock->rw_mutex);
|
||||
|
||||
return (result);
|
||||
}
|
||||
RTM_EXPORT(pthread_rwlock_timedrdlock);
|
||||
|
||||
int pthread_rwlock_timedwrlock(pthread_rwlock_t *rwlock,
|
||||
const struct timespec *abstime)
|
||||
{
|
||||
int result;
|
||||
|
||||
if (!rwlock)
|
||||
return EINVAL;
|
||||
if (rwlock->attr == -1)
|
||||
pthread_rwlock_init(rwlock, NULL);
|
||||
|
||||
if ((result = pthread_mutex_lock(&rwlock->rw_mutex)) != 0)
|
||||
return(result);
|
||||
|
||||
while (rwlock->rw_refcount != 0)
|
||||
{
|
||||
rwlock->rw_nwaitwriters++;
|
||||
/* rw_mutex will be released when waiting for rw_condwriters */
|
||||
result = pthread_cond_timedwait(&rwlock->rw_condwriters, &rwlock->rw_mutex, abstime);
|
||||
/* rw_mutex should have been taken again when returned from waiting */
|
||||
rwlock->rw_nwaitwriters--;
|
||||
|
||||
if (result != 0)
|
||||
break;
|
||||
}
|
||||
|
||||
if (result == 0)
|
||||
rwlock->rw_refcount = -1;
|
||||
|
||||
pthread_mutex_unlock(&rwlock->rw_mutex);
|
||||
|
||||
return(result);
|
||||
}
|
||||
RTM_EXPORT(pthread_rwlock_timedwrlock);
|
||||
|
||||
int pthread_rwlock_trywrlock(pthread_rwlock_t *rwlock)
|
||||
{
|
||||
int result;
|
||||
|
||||
if (!rwlock)
|
||||
return EINVAL;
|
||||
if (rwlock->attr == -1)
|
||||
pthread_rwlock_init(rwlock, NULL);
|
||||
|
||||
if ((result = pthread_mutex_lock(&rwlock->rw_mutex)) != 0)
|
||||
return(result);
|
||||
|
||||
if (rwlock->rw_refcount != 0)
|
||||
result = EBUSY; /* held by either writer or reader(s) */
|
||||
else
|
||||
rwlock->rw_refcount = -1; /* available, indicate a writer has it */
|
||||
|
||||
pthread_mutex_unlock(&rwlock->rw_mutex);
|
||||
|
||||
return(result);
|
||||
}
|
||||
RTM_EXPORT(pthread_rwlock_trywrlock);
|
||||
|
||||
int pthread_rwlock_unlock(pthread_rwlock_t *rwlock)
|
||||
{
|
||||
int result;
|
||||
|
||||
if (!rwlock)
|
||||
return EINVAL;
|
||||
if (rwlock->attr == -1)
|
||||
pthread_rwlock_init(rwlock, NULL);
|
||||
|
||||
if ( (result = pthread_mutex_lock(&rwlock->rw_mutex)) != 0)
|
||||
return(result);
|
||||
|
||||
if (rwlock->rw_refcount > 0)
|
||||
rwlock->rw_refcount--; /* releasing a reader */
|
||||
else if (rwlock->rw_refcount == -1)
|
||||
rwlock->rw_refcount = 0; /* releasing a writer */
|
||||
|
||||
/* give preference to waiting writers over waiting readers */
|
||||
if (rwlock->rw_nwaitwriters > 0)
|
||||
{
|
||||
if (rwlock->rw_refcount == 0)
|
||||
result = pthread_cond_signal(&rwlock->rw_condwriters);
|
||||
}
|
||||
else if (rwlock->rw_nwaitreaders > 0)
|
||||
{
|
||||
result = pthread_cond_broadcast(&rwlock->rw_condreaders);
|
||||
}
|
||||
|
||||
pthread_mutex_unlock(&rwlock->rw_mutex);
|
||||
|
||||
return(result);
|
||||
}
|
||||
RTM_EXPORT(pthread_rwlock_unlock);
|
||||
|
||||
int pthread_rwlock_wrlock(pthread_rwlock_t *rwlock)
|
||||
{
|
||||
int result;
|
||||
|
||||
if (!rwlock)
|
||||
return EINVAL;
|
||||
if (rwlock->attr == -1)
|
||||
pthread_rwlock_init(rwlock, NULL);
|
||||
|
||||
if ((result = pthread_mutex_lock(&rwlock->rw_mutex)) != 0)
|
||||
return(result);
|
||||
|
||||
while (rwlock->rw_refcount != 0)
|
||||
{
|
||||
rwlock->rw_nwaitwriters++;
|
||||
/* rw_mutex will be released when waiting for rw_condwriters */
|
||||
result = pthread_cond_wait(&rwlock->rw_condwriters, &rwlock->rw_mutex);
|
||||
/* rw_mutex should have been taken again when returned from waiting */
|
||||
rwlock->rw_nwaitwriters--;
|
||||
|
||||
if (result != 0)
|
||||
break;
|
||||
}
|
||||
|
||||
if (result == 0)
|
||||
rwlock->rw_refcount = -1;
|
||||
|
||||
pthread_mutex_unlock(&rwlock->rw_mutex);
|
||||
|
||||
return(result);
|
||||
}
|
||||
RTM_EXPORT(pthread_rwlock_wrlock);
|
||||
|
69
components/libc/posix/pthreads/pthread_spin.c
Normal file
69
components/libc/posix/pthreads/pthread_spin.c
Normal file
|
@ -0,0 +1,69 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2010-10-26 Bernard the first version
|
||||
*/
|
||||
|
||||
#include <pthread.h>
|
||||
|
||||
int pthread_spin_init (pthread_spinlock_t *lock, int pshared)
|
||||
{
|
||||
if (!lock)
|
||||
return EINVAL;
|
||||
|
||||
lock->lock = 0;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int pthread_spin_destroy (pthread_spinlock_t *lock)
|
||||
{
|
||||
if (!lock)
|
||||
return EINVAL;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int pthread_spin_lock (pthread_spinlock_t *lock)
|
||||
{
|
||||
if (!lock)
|
||||
return EINVAL;
|
||||
|
||||
while (!(lock->lock))
|
||||
{
|
||||
lock->lock = 1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int pthread_spin_trylock (pthread_spinlock_t *lock)
|
||||
{
|
||||
if (!lock)
|
||||
return EINVAL;
|
||||
|
||||
if (!(lock->lock))
|
||||
{
|
||||
lock->lock = 1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
return EBUSY;
|
||||
}
|
||||
|
||||
int pthread_spin_unlock (pthread_spinlock_t *lock)
|
||||
{
|
||||
if (!lock)
|
||||
return EINVAL;
|
||||
if (!(lock->lock))
|
||||
return EPERM;
|
||||
|
||||
lock->lock = 0;
|
||||
|
||||
return 0;
|
||||
}
|
110
components/libc/posix/pthreads/pthread_tls.c
Normal file
110
components/libc/posix/pthreads/pthread_tls.c
Normal file
|
@ -0,0 +1,110 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2010-10-26 Bernard the first version
|
||||
*/
|
||||
|
||||
#include <pthread.h>
|
||||
#include "pthread_internal.h"
|
||||
|
||||
_pthread_key_data_t _thread_keys[PTHREAD_KEY_MAX];
|
||||
|
||||
/* initialize key area */
|
||||
static int pthread_key_system_init(void)
|
||||
{
|
||||
rt_memset(&_thread_keys[0], 0, sizeof(_thread_keys));
|
||||
return 0;
|
||||
}
|
||||
INIT_COMPONENT_EXPORT(pthread_key_system_init);
|
||||
|
||||
void *pthread_getspecific(pthread_key_t key)
|
||||
{
|
||||
struct _pthread_data* ptd;
|
||||
|
||||
if (rt_thread_self() == NULL) return NULL;
|
||||
|
||||
/* get pthread data from user data of thread */
|
||||
ptd = (_pthread_data_t *)rt_thread_self()->user_data;
|
||||
RT_ASSERT(ptd != NULL);
|
||||
|
||||
if (ptd->tls == NULL)
|
||||
return NULL;
|
||||
|
||||
if ((key < PTHREAD_KEY_MAX) && (_thread_keys[key].is_used))
|
||||
return ptd->tls[key];
|
||||
|
||||
return NULL;
|
||||
}
|
||||
RTM_EXPORT(pthread_getspecific);
|
||||
|
||||
int pthread_setspecific(pthread_key_t key, const void *value)
|
||||
{
|
||||
struct _pthread_data* ptd;
|
||||
|
||||
if (rt_thread_self() == NULL) return EINVAL;
|
||||
|
||||
/* get pthread data from user data of thread */
|
||||
ptd = (_pthread_data_t *)rt_thread_self()->user_data;
|
||||
RT_ASSERT(ptd != NULL);
|
||||
|
||||
/* check tls area */
|
||||
if (ptd->tls == NULL)
|
||||
{
|
||||
ptd->tls = (void**)rt_malloc(sizeof(void*) * PTHREAD_KEY_MAX);
|
||||
}
|
||||
|
||||
if ((key < PTHREAD_KEY_MAX) && _thread_keys[key].is_used)
|
||||
{
|
||||
ptd->tls[key] = (void *)value;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
return EINVAL;
|
||||
}
|
||||
RTM_EXPORT(pthread_setspecific);
|
||||
|
||||
int pthread_key_create(pthread_key_t *key, void (*destructor)(void*))
|
||||
{
|
||||
rt_uint32_t index;
|
||||
|
||||
rt_enter_critical();
|
||||
for (index = 0; index < PTHREAD_KEY_MAX; index ++)
|
||||
{
|
||||
if (_thread_keys[index].is_used == 0)
|
||||
{
|
||||
_thread_keys[index].is_used = 1;
|
||||
_thread_keys[index].destructor = destructor;
|
||||
|
||||
*key = index;
|
||||
|
||||
rt_exit_critical();
|
||||
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
rt_exit_critical();
|
||||
|
||||
return EAGAIN;
|
||||
}
|
||||
RTM_EXPORT(pthread_key_create);
|
||||
|
||||
int pthread_key_delete(pthread_key_t key)
|
||||
{
|
||||
if (key >= PTHREAD_KEY_MAX)
|
||||
return EINVAL;
|
||||
|
||||
rt_enter_critical();
|
||||
_thread_keys[key].is_used = 0;
|
||||
_thread_keys[key].destructor = 0;
|
||||
rt_exit_critical();
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(pthread_key_delete);
|
||||
|
57
components/libc/posix/pthreads/sched.c
Normal file
57
components/libc/posix/pthreads/sched.c
Normal file
|
@ -0,0 +1,57 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
*/
|
||||
|
||||
#include <sched.h>
|
||||
|
||||
int sched_yield(void)
|
||||
{
|
||||
rt_thread_yield();
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(sched_yield);
|
||||
|
||||
int sched_get_priority_min(int policy)
|
||||
{
|
||||
if (policy != SCHED_FIFO && policy != SCHED_RR)
|
||||
return EINVAL;
|
||||
|
||||
return 0;
|
||||
}
|
||||
RTM_EXPORT(sched_get_priority_min);
|
||||
|
||||
int sched_get_priority_max(int policy)
|
||||
{
|
||||
if (policy != SCHED_FIFO && policy != SCHED_RR)
|
||||
return EINVAL;
|
||||
|
||||
return RT_THREAD_PRIORITY_MAX - 1;
|
||||
}
|
||||
RTM_EXPORT(sched_get_priority_max);
|
||||
|
||||
int sched_setscheduler(pid_t pid, int policy)
|
||||
{
|
||||
return EOPNOTSUPP;
|
||||
}
|
||||
RTM_EXPORT(sched_setscheduler);
|
||||
|
||||
int sched_rr_get_interval(pid_t pid, struct timespec *tp)
|
||||
{
|
||||
if(pid != 0)
|
||||
{
|
||||
return EINVAL;
|
||||
}
|
||||
|
||||
rt_set_errno(-EINVAL);
|
||||
|
||||
/* course model, don't support */
|
||||
// TODO
|
||||
return -1;
|
||||
}
|
||||
RTM_EXPORT(sched_rr_get_interval);
|
41
components/libc/posix/pthreads/sched.h
Normal file
41
components/libc/posix/pthreads/sched.h
Normal file
|
@ -0,0 +1,41 @@
|
|||
/*
|
||||
* Copyright (c) 2006-2021, RT-Thread Development Team
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
*/
|
||||
|
||||
#ifndef __SCHED_H__
|
||||
#define __SCHED_H__
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <pthread.h>
|
||||
|
||||
/* Thread scheduling policies */
|
||||
enum
|
||||
{
|
||||
SCHED_OTHER = 0,
|
||||
SCHED_FIFO,
|
||||
SCHED_RR,
|
||||
SCHED_MIN = SCHED_OTHER,
|
||||
SCHED_MAX = SCHED_RR
|
||||
};
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C"
|
||||
{
|
||||
#endif
|
||||
|
||||
int sched_yield(void);
|
||||
int sched_get_priority_min(int policy);
|
||||
int sched_get_priority_max(int policy);
|
||||
int sched_rr_get_interval(pid_t pid, struct timespec *tp);
|
||||
int sched_setscheduler(pid_t pid, int policy);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif
|
Loading…
Add table
Add a link
Reference in a new issue