s32 LWP_CreateThread(lwp_t *thethread,void* (*entry)(void *),void *arg,void *stackbase,u32 stack_size,u8 prio)
{
u32 status;
lwp_cntrl *lwp_thread;
if(!thethread || !entry) return -1;
lwp_thread = __lwp_cntrl_allocate();
if(!lwp_thread) return -1;
status = __lwp_thread_init(lwp_thread,stackbase,stack_size,__lwp_priotocore(prio),0,TRUE);
if(!status) {
__lwp_cntrl_free(lwp_thread);
__lwp_thread_dispatchenable();
return -1;
}
status = __lwp_thread_start(lwp_thread,entry,arg);
if(!status) {
__lwp_cntrl_free(lwp_thread);
__lwp_thread_dispatchenable();
return -1;
}
*thethread = (lwp_t)(LWP_OBJMASKTYPE(LWP_OBJTYPE_THREAD)|LWP_OBJMASKID(lwp_thread->object.id));
__lwp_thread_dispatchenable();
return 0;
}
lwp_t LWP_GetSelf()
{
lwp_t ret;
__lwp_thread_dispatchdisable();
ret = (lwp_t)(LWP_OBJMASKTYPE(LWP_OBJTYPE_THREAD)|LWP_OBJMASKID(_thr_executing->object.id));
__lwp_thread_dispatchunnest();
return ret;
}
frame_context* __lwp_thread_context(lwp_t thr_id)
{
lwp_cntrl *thethread;
frame_context *pctx = NULL;
LWP_CHECK_THREAD(thr_id);
thethread = (lwp_cntrl*)__lwp_objmgr_getnoprotection(&_lwp_thr_objects,LWP_OBJMASKID(thr_id));
if(thethread) pctx = &thethread->context;
return pctx;
}
BOOL __lwp_thread_isalive(lwp_t thr_id)
{
if(thr_id==LWP_THREAD_NULL || LWP_OBJTYPE(thr_id)!=LWP_OBJTYPE_THREAD) return FALSE;
lwp_cntrl *thethread = (lwp_cntrl*)__lwp_objmgr_getnoprotection(&_lwp_thr_objects,LWP_OBJMASKID(thr_id));
if(thethread) {
u32 *stackbase = thethread->stack;
if(stackbase[0]==0xDEADBABE && !__lwp_statedormant(thethread->cur_state) && !__lwp_statetransient(thethread->cur_state))
return TRUE;
}
return FALSE;
}
s32 LWP_InitQueue(lwpq_t *thequeue)
{
tqueue_st *tq;
if(!thequeue) return -1;
tq = __lwp_tqueue_allocate();
if(!tq) return -1;
__lwp_threadqueue_init(&tq->tqueue,LWP_THREADQ_MODEFIFO,LWP_STATES_WAITING_ON_THREADQ,0);
*thequeue = (lwpq_t)(LWP_OBJMASKTYPE(LWP_OBJTYPE_TQUEUE)|LWP_OBJMASKID(tq->object.id));
__lwp_thread_dispatchenable();
return 0;
}
s32 LWP_CondInit(cond_t *cond)
{
cond_st *ret;
if(!cond) return -1;
ret = __lwp_cond_allocate();
if(!ret) return ENOMEM;
ret->lock = LWP_MUTEX_NULL;
__lwp_threadqueue_init(&ret->wait_queue,LWP_THREADQ_MODEFIFO,LWP_STATES_WAITING_FOR_CONDVAR,ETIMEDOUT);
*cond = (cond_t)(LWP_OBJMASKTYPE(LWP_OBJTYPE_COND)|LWP_OBJMASKID(ret->object.id));
__lwp_thread_dispatchenable();
return 0;
}
s32 MQ_Init(mqbox_t *mqbox,u32 count)
{
mq_attr attr;
mqbox_st *ret = NULL;
if(!mqbox) return -1;
ret = __lwp_mqbox_allocate();
if(!ret) return MQ_ERROR_TOOMANY;
attr.mode = LWP_MQ_FIFO;
if(!__lwpmq_initialize(&ret->mqueue,&attr,count,sizeof(mqmsg_t))) {
__lwp_mqbox_free(ret);
__lwp_thread_dispatchenable();
return MQ_ERROR_TOOMANY;
}
*mqbox = (mqbox_t)(LWP_OBJMASKTYPE(LWP_OBJTYPE_MBOX)|LWP_OBJMASKID(ret->object.id));
__lwp_thread_dispatchenable();
return MQ_ERROR_SUCCESSFUL;
}
static __inline__ tqueue_st* __lwp_tqueue_open(lwpq_t tqueue)
{
LWP_CHECK_TQUEUE(tqueue);
return (tqueue_st*)__lwp_objmgr_get(&_lwp_tqueue_objects,LWP_OBJMASKID(tqueue));
}
static __inline__ lwp_cntrl* __lwp_cntrl_open(lwp_t thr_id)
{
LWP_CHECK_THREAD(thr_id);
return (lwp_cntrl*)__lwp_objmgr_get(&_lwp_thr_objects,LWP_OBJMASKID(thr_id));
}
BOOL __lwp_thread_exists(lwp_t thr_id)
{
if(thr_id==LWP_THREAD_NULL || LWP_OBJTYPE(thr_id)!=LWP_OBJTYPE_THREAD) return FALSE;
return (__lwp_objmgr_getnoprotection(&_lwp_thr_objects,LWP_OBJMASKID(thr_id))!=NULL);
}
static __inline__ cond_st* __lwp_cond_open(cond_t cond)
{
LWP_CHECK_COND(cond);
return (cond_st*)__lwp_objmgr_get(&_lwp_cond_objects,LWP_OBJMASKID(cond));
}
static __inline__ mqbox_st* __lwp_mqbox_open(mqbox_t mbox)
{
LWP_CHECK_MBOX(mbox);
return (mqbox_st*)__lwp_objmgr_get(&_lwp_mqbox_objects,LWP_OBJMASKID(mbox));
}
