void thinkos_ev_wait_svc(int32_t * arg)
{
unsigned int wq = arg[0];
unsigned int no = wq - THINKOS_EVENT_BASE;
int self = thinkos_rt.active;
unsigned int ev;
#if THINKOS_ENABLE_ARG_CHECK
if (no >= THINKOS_EVENT_MAX) {
DCC_LOG1(LOG_ERROR, "object %d is not an event set!", wq);
arg[0] = THINKOS_EINVAL;
return;
}
#if THINKOS_ENABLE_EVENT_ALLOC
if (__bit_mem_rd(&thinkos_rt.ev_alloc, no) == 0) {
DCC_LOG1(LOG_ERROR, "invalid event set %d!", wq);
arg[0] = THINKOS_EINVAL;
return;
}
#endif
#endif
cm3_cpsid_i();
/* check for any pending unmasked event */
if ((ev = __clz(__rbit(thinkos_rt.ev[no].pend &
thinkos_rt.ev[no].mask))) < 32) {
DCC_LOG2(LOG_MSG, "set=0x%08x msk=0x%08x",
thinkos_rt.ev[no].pend, thinkos_rt.ev[no].mask);
__bit_mem_wr(&thinkos_rt.ev[no].pend, ev, 0);
DCC_LOG2(LOG_INFO, "pending event %d.%d!", wq, ev);
arg[0] = ev;
cm3_cpsie_i();
return;
}
/* insert into the wait queue */
__thinkos_wq_insert(wq, self);
/* wait for event */
/* remove from the ready wait queue */
__bit_mem_wr(&thinkos_rt.wq_ready, thinkos_rt.active, 0);
#if THINKOS_ENABLE_TIMESHARE
/* if the ready queue is empty, collect
the threads from the CPU wait queue */
if (thinkos_rt.wq_ready == 0) {
thinkos_rt.wq_ready = thinkos_rt.wq_tmshare;
thinkos_rt.wq_tmshare = 0;
}
#endif
cm3_cpsie_i();
DCC_LOG2(LOG_INFO, "<%d> waiting for event %d.xx ...", self, wq);
/* signal the scheduler ... */
__thinkos_defer_sched();
}
// ARM-LABEL: test_rbit
// AArch32: call i32 @llvm.bitreverse.i32
// AArch64: call i32 @llvm.bitreverse.i32
uint32_t test_rbit(uint32_t t) {
return __rbit(t);
}
void thinkos_ev_unmask_svc(int32_t * arg)
{
unsigned int wq = arg[0];
uint32_t mask = arg[1];
unsigned int no = wq - THINKOS_EVENT_BASE;
unsigned int ev;
int th;
#if THINKOS_ENABLE_ARG_CHECK
if (no >= THINKOS_EVENT_MAX) {
DCC_LOG1(LOG_ERROR, "object %d is not an event set!", wq);
arg[0] = THINKOS_EINVAL;
return;
}
#if THINKOS_ENABLE_EVENT_ALLOC
if (__bit_mem_rd(&thinkos_rt.ev_alloc, no) == 0) {
DCC_LOG1(LOG_ERROR, "invalid event set %d!", wq);
arg[0] = THINKOS_EINVAL;
return;
}
#endif
#endif
cm3_cpsid_i();
/* unmask the events on the mask bitmap */
thinkos_rt.ev[no].mask |= mask;
/* wake up the first unmasked thread if any. */
if ((ev = __clz(__rbit(thinkos_rt.ev[no].pend & mask))) < 32) {
if ((th = __thinkos_wq_head(wq)) != THINKOS_THREAD_NULL) {
/* a pending event was unmaksed and there is a thread waiting on
the queue, clear the event pending flag and
wakes up the thread. */
__bit_mem_wr(&thinkos_rt.ev[no].pend, ev, 0);
/* wakeup from the event wait queue, set the return of
the thread to the event */
__thinkos_wakeup_return(wq, th, ev);
DCC_LOG3(LOG_TRACE, "<%d> waked up with event %d.%d", th, wq, ev);
/* signal the scheduler ... */
__thinkos_defer_sched();
} else {
/* no threads waiting */
cm3_cpsie_i();
return;
}
}
/* wake up as many other threads as possible */
while ((ev = __clz(__rbit(thinkos_rt.ev[no].pend & mask))) < 32) {
if ((th = __thinkos_wq_head(wq)) != THINKOS_THREAD_NULL) {
/* a pending event was unmaksed and there is a thread waiting on
the queue, clear the event pending flag and
wakes up the thread. */
__bit_mem_wr(&thinkos_rt.ev[no].pend, ev, 0);
/* wakeup from the event wait queue, set the return of
the thread to the event */
__thinkos_wakeup_return(wq, th, ev);
DCC_LOG3(LOG_TRACE, "<%d> waked up with event %d.%d", th, wq, ev);
} else {
/* no more threads waiting */
break;
}
}
cm3_cpsie_i();
}
void thinkos_ev_timedwait_svc(int32_t * arg)
{
unsigned int wq = arg[0];
uint32_t ms = (uint32_t)arg[1];
unsigned int no = wq - THINKOS_EVENT_BASE;
int self = thinkos_rt.active;
unsigned int ev;
#if THINKOS_ENABLE_ARG_CHECK
if (no >= THINKOS_EVENT_MAX) {
DCC_LOG1(LOG_ERROR, "object %d is not an event set!", wq);
arg[0] = THINKOS_EINVAL;
return;
}
#if THINKOS_ENABLE_EVENT_ALLOC
if (__bit_mem_rd(&thinkos_rt.ev_alloc, no) == 0) {
DCC_LOG1(LOG_ERROR, "invalid event set %d!", wq);
arg[0] = THINKOS_EINVAL;
return;
}
#endif
#endif
cm3_cpsid_i();
/* check for any pending unmasked event */
if ((ev = __clz(__rbit(thinkos_rt.ev[no].pend &
thinkos_rt.ev[no].mask))) < 32) {
__bit_mem_wr(&thinkos_rt.ev[no].pend, ev, 0);
arg[0] = ev;
cm3_cpsie_i();
return;
}
/* insert into the mutex wait queue */
__thinkos_tmdwq_insert(wq, self, ms);
/* wait for event */
/* remove from the ready wait queue */
__bit_mem_wr(&thinkos_rt.wq_ready, thinkos_rt.active, 0);
#if THINKOS_ENABLE_TIMESHARE
/* if the ready queue is empty, collect
the threads from the CPU wait queue */
if (thinkos_rt.wq_ready == 0) {
thinkos_rt.wq_ready = thinkos_rt.wq_tmshare;
thinkos_rt.wq_tmshare = 0;
}
#endif
/* Set the default return value to timeout. The
ev_rise() call will change it to the active event */
arg[0] = THINKOS_ETIMEDOUT;
cm3_cpsie_i();
DCC_LOG2(LOG_INFO, "<%d> waiting for event %d...", self, wq);
/* signal the scheduler ... */
__thinkos_defer_sched();
}
