ER
sac_sem(ID semid, const ACVCT *p_acvct)
{
SEMCB *p_semcb;
SEMINIB *p_seminib;
ER ercd;
LOG_SAC_SEM_ENTER(semid, p_acvct);
CHECK_TSKCTX_UNL();
CHECK_SEMID(semid);
CHECK_MACV_READ(p_acvct, ACVCT);
p_semcb = get_semcb(semid);
t_lock_cpu();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_semcb->p_seminib->acvct.acptn3)) {
ercd = E_OACV;
}
else if (SEMID(p_semcb) > tmax_ssemid) {
p_seminib = (SEMINIB *)(p_semcb->p_seminib);
p_seminib->acvct = *p_acvct;
ercd = E_OK;
}
else {
ercd = E_OBJ;
}
t_unlock_cpu();
error_exit:
LOG_SAC_SEM_LEAVE(ercd);
return(ercd);
}
SYSCALL ER
twai_sem(ID semid, TMO tmout)
{
SEMCB *semcb;
WINFO_WOBJ winfo;
TMEVTB tmevtb;
ER ercd;
LOG_TWAI_SEM_ENTER(semid, tmout);
CHECK_DISPATCH();
CHECK_SEMID(semid);
CHECK_TMOUT(tmout);
semcb = get_semcb(semid);
t_lock_cpu();
if (semcb->semcnt >= 1) {
semcb->semcnt -= 1;
ercd = E_OK;
}
else if (tmout == TMO_POL) {
ercd = E_TMOUT;
}
else {
wobj_make_wait_tmout((WOBJCB *) semcb, &winfo, &tmevtb, tmout);
dispatch();
ercd = winfo.winfo.wercd;
}
t_unlock_cpu();
exit:
LOG_TWAI_SEM_LEAVE(ercd);
return(ercd);
}
SYSCALL ER
sig_sem(ID semid)
{
SEMCB *semcb;
TCB *tcb;
ER ercd;
LOG_SIG_SEM_ENTER(semid);
CHECK_TSKCTX_UNL();
CHECK_SEMID(semid);
semcb = get_semcb(semid);
t_lock_cpu();
if (!(queue_empty(&(semcb->wait_queue)))) {
tcb = (TCB *) queue_delete_next(&(semcb->wait_queue));
if (wait_complete(tcb)) {
dispatch();
}
ercd = E_OK;
}
else if (semcb->semcnt < semcb->seminib->maxsem) {
semcb->semcnt += 1;
ercd = E_OK;
}
else {
ercd = E_QOVR;
}
t_unlock_cpu();
exit:
LOG_SIG_SEM_LEAVE(ercd);
return(ercd);
}
SYSCALL ER
pol_sem(ID semid)
{
SEMCB *semcb;
ER ercd;
LOG_POL_SEM_ENTER(semid);
CHECK_TSKCTX_UNL();
CHECK_SEMID(semid);
semcb = get_semcb(semid);
t_lock_cpu();
if (semcb->semcnt >= 1) {
semcb->semcnt -= 1;
ercd = E_OK;
}
else {
ercd = E_TMOUT;
}
t_unlock_cpu();
exit:
LOG_POL_SEM_LEAVE(ercd);
return(ercd);
}
SYSCALL ER
wai_sem(ID semid)
{
SEMCB *semcb;
WINFO_WOBJ winfo;
ER ercd;
LOG_WAI_SEM_ENTER(semid);
CHECK_DISPATCH();
CHECK_SEMID(semid);
semcb = get_semcb(semid);
t_lock_cpu();
if (semcb->semcnt >= 1) {
semcb->semcnt -= 1;
ercd = E_OK;
}
else {
wobj_make_wait((WOBJCB *) semcb, &winfo);
dispatch();
ercd = winfo.winfo.wercd;
}
t_unlock_cpu();
exit:
LOG_WAI_SEM_LEAVE(ercd);
return(ercd);
}
JSP_L1_CODE
SYSCALL ER
isig_sem(ID semid)
{
SEMCB *semcb;
TCB *tcb;
ER ercd;
LOG_ISIG_SEM_ENTER(semid);
CHECK_INTCTX_UNL();
CHECK_SEMID(semid);
semcb = get_semcb(semid);
i_lock_cpu();
if (!queue_empty(&(semcb->wait_queue))) {
tcb = (TCB *) queue_delete_next(&(semcb->wait_queue));
if (wait_complete(tcb)) {
reqflg = TRUE;
}
ercd = E_OK;
}
else if (semcb->semcnt < semcb->seminib->maxsem) {
semcb->semcnt += 1;
ercd = E_OK;
}
else {
ercd = E_QOVR;
}
i_unlock_cpu();
exit:
LOG_ISIG_SEM_LEAVE(ercd);
return(ercd);
}
static ER
ipol_sem(ID semid)
{
SEMCB *p_semcb;
ER ercd;
// LOG_POL_SEM_ENTER(semid);
// CHECK_TSKCTX_UNL();
// CHECK_SEMID(semid);
p_semcb = get_semcb(semid);
t_lock_cpu();
/* if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else */if (p_semcb->semcnt >= 1) {
p_semcb->semcnt -= 1;
ercd = E_OK;
}
else {
ercd = E_TMOUT;
}
t_unlock_cpu();
// error_exit:
// LOG_POL_SEM_LEAVE(ercd);
return(ercd);
}
ER
ref_sem(ID semid, T_RSEM *pk_rsem)
{
SEMCB *p_semcb;
ER ercd;
LOG_REF_SEM_ENTER(semid, pk_rsem);
CHECK_TSKCTX_UNL();
CHECK_ID(VALID_SEMID(semid));
p_semcb = get_semcb(semid);
lock_cpu();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else {
pk_rsem->wtskid = wait_tskid(&(p_semcb->wait_queue));
pk_rsem->semcnt = p_semcb->semcnt;
ercd = E_OK;
}
unlock_cpu();
error_exit:
LOG_REF_SEM_LEAVE(ercd, pk_rsem);
return(ercd);
}
ER
wai_sem(ID semid)
{
SEMCB *p_semcb;
WINFO_SEM winfo_sem;
ER ercd;
LOG_WAI_SEM_ENTER(semid);
CHECK_DISPATCH();
CHECK_ID(VALID_SEMID(semid));
p_semcb = get_semcb(semid);
lock_cpu_dsp();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (p_runtsk->raster) {
ercd = E_RASTER;
}
else if (p_semcb->semcnt >= 1) {
p_semcb->semcnt -= 1;
ercd = E_OK;
}
else {
p_runtsk->tstat = TS_WAITING_SEM;
wobj_make_wait((WOBJCB *) p_semcb, (WINFO_WOBJ *) &winfo_sem);
dispatch();
ercd = winfo_sem.winfo.wercd;
}
unlock_cpu_dsp();
error_exit:
LOG_WAI_SEM_LEAVE(ercd);
return(ercd);
}
ER
pol_sem(ID semid)
{
SEMCB *p_semcb;
ER ercd;
LOG_POL_SEM_ENTER(semid);
CHECK_TSKCTX_UNL();
CHECK_ID(VALID_SEMID(semid));
p_semcb = get_semcb(semid);
lock_cpu();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (p_semcb->semcnt >= 1) {
p_semcb->semcnt -= 1;
ercd = E_OK;
}
else {
ercd = E_TMOUT;
}
unlock_cpu();
error_exit:
LOG_POL_SEM_LEAVE(ercd);
return(ercd);
}
ER
ini_sem(ID semid)
{
SEMCB *p_semcb;
ER ercd;
LOG_INI_SEM_ENTER(semid);
CHECK_TSKCTX_UNL();
CHECK_ID(VALID_SEMID(semid));
p_semcb = get_semcb(semid);
lock_cpu();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else {
init_wait_queue(&(p_semcb->wait_queue));
p_semcb->semcnt = p_semcb->p_seminib->isemcnt;
if (p_runtsk != p_schedtsk) {
dispatch();
}
ercd = E_OK;
}
unlock_cpu();
error_exit:
LOG_INI_SEM_LEAVE(ercd);
return(ercd);
}
ER
del_sem(ID semid)
{
SEMCB *p_semcb;
SEMINIB *p_seminib;
ER ercd;
LOG_DEL_SEM_ENTER(semid);
CHECK_TSKCTX_UNL();
CHECK_ID(VALID_SEMID(semid));
p_semcb = get_semcb(semid);
lock_cpu();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (semid <= tmax_ssemid) {
ercd = E_OBJ;
}
else {
init_wait_queue(&(p_semcb->wait_queue));
p_seminib = (SEMINIB *)(p_semcb->p_seminib);
p_seminib->sematr = TA_NOEXS;
queue_insert_prev(&free_semcb, &(p_semcb->wait_queue));
if (p_runtsk != p_schedtsk) {
dispatch();
}
ercd = E_OK;
}
unlock_cpu();
error_exit:
LOG_DEL_SEM_LEAVE(ercd);
return(ercd);
}
/*
* Processing if the priority of wait task changes
*/
LOCAL void sem_chg_pri( TCB *tcb, INT oldpri )
{
SEMCB *semcb;
QUEUE *queue;
TCB *top;
semcb = get_semcb(tcb->wid);
if ( oldpri >= 0 ) {
/* Reorder wait line */
knl_gcb_change_priority((GCB*)semcb, tcb);
}
if ( (semcb->sematr & TA_CNT) != 0 ) {
return;
}
/* From the head task in a wait queue, allocate semaphore counts
and release wait state as much as possible */
queue = semcb->wait_queue.next;
while ( queue != &semcb->wait_queue ) {
top = (TCB*)queue;
queue = queue->next;
/* Meet condition for releasing wait? */
if ( semcb->semcnt < top->winfo.sem.cnt ) {
break;
}
/* Release wait */
knl_wait_release_ok(top);
semcb->semcnt -= top->winfo.sem.cnt;
}
}
ER
ref_sem(ID semid, T_RSEM *pk_rsem)
{
SEMCB *p_semcb;
ER ercd;
LOG_REF_SEM_ENTER(semid, pk_rsem);
CHECK_TSKCTX_UNL();
CHECK_SEMID(semid);
CHECK_MACV_WRITE(pk_rsem, T_RSEM);
p_semcb = get_semcb(semid);
t_lock_cpu();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_semcb->p_seminib->acvct.acptn4)) {
ercd = E_OACV;
}
else {
pk_rsem->wtskid = wait_tskid(&(p_semcb->wait_queue));
pk_rsem->semcnt = p_semcb->semcnt;
ercd = E_OK;
}
t_unlock_cpu();
error_exit:
LOG_REF_SEM_LEAVE(ercd, pk_rsem);
return(ercd);
}
ER
ini_sem(ID semid)
{
SEMCB *p_semcb;
bool_t dspreq;
ER ercd;
LOG_INI_SEM_ENTER(semid);
CHECK_TSKCTX_UNL();
CHECK_SEMID(semid);
p_semcb = get_semcb(semid);
t_lock_cpu();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_semcb->p_seminib->acvct.acptn3)) {
ercd = E_OACV;
}
else {
dspreq = init_wait_queue(&(p_semcb->wait_queue));
p_semcb->semcnt = p_semcb->p_seminib->isemcnt;
if (dspreq) {
dispatch();
}
ercd = E_OK;
}
t_unlock_cpu();
error_exit:
LOG_INI_SEM_LEAVE(ercd);
return(ercd);
}
/*
* Refer wait queue
*/
SYSCALL INT td_sem_que_impl( ID semid, ID list[], INT nent )
{
SEMCB *semcb;
QUEUE *q;
ER ercd;
CHECK_SEMID(semid);
semcb = get_semcb(semid);
BEGIN_DISABLE_INTERRUPT;
if ( semcb->semid == 0 ) {
ercd = E_NOEXS;
} else {
INT n = 0;
for ( q = semcb->wait_queue.next; q != &semcb->wait_queue; q = q->next ) {
if ( n++ < nent ) {
*list++ = ((TCB*)q)->tskid;
}
}
ercd = n;
}
END_DISABLE_INTERRUPT;
return ercd;
}
ER
pol_sem(ID semid)
{
SEMCB *p_semcb;
ER ercd;
LOG_POL_SEM_ENTER(semid);
CHECK_TSKCTX_UNL();
CHECK_SEMID(semid);
p_semcb = get_semcb(semid);
t_lock_cpu();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_semcb->p_seminib->acvct.acptn2)) {
ercd = E_OACV;
}
else if (p_semcb->semcnt >= 1) {
p_semcb->semcnt -= 1;
ercd = E_OK;
}
else {
ercd = E_TMOUT;
}
t_unlock_cpu();
error_exit:
LOG_POL_SEM_LEAVE(ercd);
return(ercd);
}
static ER
bit_semaphore(ID semid)
{
SEMCB *p_semcb;
const SEMINIB *p_seminib;
uint_t semcnt;
QUEUE *p_queue;
TCB *p_tcb;
if (!(TMIN_SEMID <= (semid) && (semid) <= tmax_semid)) {
return(E_ID);
}
p_semcb = get_semcb(semid);
p_seminib = p_semcb->p_seminib;
semcnt = p_semcb->semcnt;
/*
* 初期化ブロックへのポインタの検査
*/
if (p_seminib != &(seminib_table[INDEX_SEM(semid)])) {
return(E_SYS_LINENO);
}
/*
* semcntの検査
*/
if (semcnt > p_seminib->maxsem) {
return(E_SYS_LINENO);
}
/*
* wait_queueの検査
*/
if (semcnt == 0) {
p_queue = p_semcb->wait_queue.p_next;
while (p_queue != &(p_semcb->wait_queue)) {
p_tcb = (TCB *) p_queue;
p_queue = p_queue->p_next;
if (!VALID_TCB(p_tcb)) {
return(E_SYS_LINENO);
}
if (p_tcb->tstat != (TS_WAITING | TS_WAIT_SEM)) {
return(E_SYS_LINENO);
}
if (p_semcb != ((WINFO_SEM *)(p_tcb->p_winfo))->p_semcb) {
return(E_SYS_LINENO);
}
}
}
else {
if (!queue_empty(&(p_semcb->wait_queue))) {
return(E_SYS_LINENO);
}
}
return(E_OK);
}
/*
* Signal semaphore
*/
SYSCALL ER tk_sig_sem_impl( ID semid, INT cnt )
{
SEMCB *semcb;
TCB *tcb;
QUEUE *queue;
ER ercd = E_OK;
CHECK_SEMID(semid);
CHECK_PAR(cnt > 0);
semcb = get_semcb(semid);
BEGIN_CRITICAL_SECTION;
if ( semcb->semid == 0 ) {
ercd = E_NOEXS;
goto error_exit;
}
if ( cnt > (semcb->maxsem - semcb->semcnt) ) {
ercd = E_QOVR;
goto error_exit;
}
/* Return semaphore counts */
semcb->semcnt += cnt;
/* Search task that frees wait */
queue = semcb->wait_queue.next;
while ( queue != &semcb->wait_queue ) {
tcb = (TCB*)queue;
queue = queue->next;
/* Meet condition for Releasing wait? */
if ( semcb->semcnt < tcb->winfo.sem.cnt ) {
if ( (semcb->sematr & TA_CNT) == 0 ) {
break;
}
continue;
}
/* Release wait */
knl_wait_release_ok(tcb);
semcb->semcnt -= tcb->winfo.sem.cnt;
if ( semcb->semcnt <= 0 ) {
break;
}
}
error_exit:
END_CRITICAL_SECTION;
return ercd;
}
ER
sig_sem(ID semid)
{
SEMCB *p_semcb;
TCB *p_tcb;
ER ercd;
LOG_SIG_SEM_ENTER(semid);
CHECK_UNL();
CHECK_ID(VALID_SEMID(semid));
p_semcb = get_semcb(semid);
lock_cpu();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_semcb->p_seminib->acvct.acptn1)) {
ercd = E_OACV;
}
else if (!queue_empty(&(p_semcb->wait_queue))) {
p_tcb = (TCB *) queue_delete_next(&(p_semcb->wait_queue));
wait_complete(p_tcb);
if (p_runtsk != p_schedtsk) {
if (!sense_context()) {
dispatch();
}
else {
request_dispatch_retint();
}
}
ercd = E_OK;
}
else if (p_semcb->semcnt < p_semcb->p_seminib->maxsem) {
p_semcb->semcnt += 1;
ercd = E_OK;
}
else {
ercd = E_QOVR;
}
unlock_cpu();
error_exit:
LOG_SIG_SEM_LEAVE(ercd);
return(ercd);
}
/*
* Wait on semaphore
*/
SYSCALL ER tk_wai_sem_impl( ID semid, INT cnt, TMO tmout )
{
SEMCB *semcb;
ER ercd = E_OK;
CHECK_SEMID(semid);
CHECK_PAR(cnt > 0);
CHECK_TMOUT(tmout);
CHECK_DISPATCH();
semcb = get_semcb(semid);
BEGIN_CRITICAL_SECTION;
if ( semcb->semid == 0 ) {
ercd = E_NOEXS;
goto error_exit;
}
#if CHK_PAR
if ( cnt > semcb->maxsem ) {
ercd = E_PAR;
goto error_exit;
}
#endif
if ( ((semcb->sematr & TA_CNT) != 0
|| knl_gcb_top_of_wait_queue((GCB*)semcb, knl_ctxtsk) == knl_ctxtsk)
&& semcb->semcnt >= cnt ) {
/* Get semaphore count */
semcb->semcnt -= cnt;
} else {
/* Ready for wait */
knl_ctxtsk->wspec = ( (semcb->sematr & TA_TPRI) != 0 )?
&knl_wspec_sem_tpri: &knl_wspec_sem_tfifo;
knl_ctxtsk->wercd = &ercd;
knl_ctxtsk->winfo.sem.cnt = cnt;
knl_gcb_make_wait((GCB*)semcb, tmout);
}
error_exit:
END_CRITICAL_SECTION;
return ercd;
}
ER
twai_sem(ID semid, TMO tmout)
{
SEMCB *p_semcb;
WINFO_SEM winfo_sem;
TMEVTB tmevtb;
ER ercd;
LOG_TWAI_SEM_ENTER(semid, tmout);
CHECK_DISPATCH();
CHECK_SEMID(semid);
CHECK_TMOUT(tmout);
p_semcb = get_semcb(semid);
t_lock_cpu();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_semcb->p_seminib->acvct.acptn2)) {
ercd = E_OACV;
}
else if (p_semcb->semcnt >= 1) {
p_semcb->semcnt -= 1;
ercd = E_OK;
}
else if (tmout == TMO_POL) {
ercd = E_TMOUT;
}
else if (p_runtsk->waifbd) {
ercd = E_RLWAI;
}
else {
p_runtsk->tstat = (TS_WAITING | TS_WAIT_SEM);
wobj_make_wait_tmout((WOBJCB *) p_semcb, (WINFO_WOBJ *) &winfo_sem,
&tmevtb, tmout);
dispatch();
ercd = winfo_sem.winfo.wercd;
}
t_unlock_cpu();
error_exit:
LOG_TWAI_SEM_LEAVE(ercd);
return(ercd);
}
ER
twai_sem(ID semid, TMO tmout)
{
SEMCB *p_semcb;
WINFO_SEM winfo_sem;
TMEVTB tmevtb;
ER ercd;
LOG_TWAI_SEM_ENTER(semid, tmout);
CHECK_DISPATCH();
CHECK_ID(VALID_SEMID(semid));
CHECK_PAR(VALID_TMOUT(tmout));
p_semcb = get_semcb(semid);
lock_cpu_dsp();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_semcb->p_seminib->acvct.acptn2)) {
ercd = E_OACV;
}
else if (p_runtsk->raster) {
ercd = E_RASTER;
}
else if (p_semcb->semcnt >= 1) {
p_semcb->semcnt -= 1;
ercd = E_OK;
}
else if (tmout == TMO_POL) {
ercd = E_TMOUT;
}
else {
wobj_make_wait_tmout((WOBJCB *) p_semcb, TS_WAITING_SEM,
(WINFO_WOBJ *) &winfo_sem, &tmevtb, tmout);
dispatch();
ercd = winfo_sem.winfo.wercd;
}
unlock_cpu_dsp();
error_exit:
LOG_TWAI_SEM_LEAVE(ercd);
return(ercd);
}
/*
* Refer object state
*/
SYSCALL ER td_ref_sem_impl( ID semid, TD_RSEM *pk_rsem )
{
SEMCB *semcb;
ER ercd = E_OK;
CHECK_SEMID(semid);
semcb = get_semcb(semid);
BEGIN_DISABLE_INTERRUPT;
if ( semcb->semid == 0 ) {
ercd = E_NOEXS;
} else {
pk_rsem->exinf = semcb->exinf;
pk_rsem->wtsk = knl_wait_tskid(&semcb->wait_queue);
pk_rsem->semcnt = semcb->semcnt;
}
END_DISABLE_INTERRUPT;
return ercd;
}
/*
* Refer semaphore state
*/
SYSCALL ER tk_ref_sem_impl( ID semid, T_RSEM *pk_rsem )
{
SEMCB *semcb;
ER ercd = E_OK;
CHECK_SEMID(semid);
semcb = get_semcb(semid);
BEGIN_CRITICAL_SECTION;
if ( semcb->semid == 0 ) {
ercd = E_NOEXS;
} else {
pk_rsem->exinf = semcb->exinf;
pk_rsem->wtsk = knl_wait_tskid(&semcb->wait_queue);
pk_rsem->semcnt = semcb->semcnt;
}
END_CRITICAL_SECTION;
return ercd;
}
ER
del_sem(ID semid)
{
SEMCB *p_semcb;
SEMINIB *p_seminib;
bool_t dspreq;
ER ercd;
LOG_DEL_SEM_ENTER(semid);
CHECK_TSKCTX_UNL();
CHECK_SEMID(semid);
p_semcb = get_semcb(semid);
t_lock_cpu();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_semcb->p_seminib->acvct.acptn3)) {
ercd = E_OACV;
}
else if (SEMID(p_semcb) > tmax_ssemid) {
dspreq = init_wait_queue(&(p_semcb->wait_queue));
p_seminib = (SEMINIB *)(p_semcb->p_seminib);
p_seminib->sematr = TA_NOEXS;
queue_insert_prev(&free_semcb, &(p_semcb->wait_queue));
if (dspreq) {
dispatch();
}
ercd = E_OK;
}
else {
ercd = E_OBJ;
}
t_unlock_cpu();
error_exit:
LOG_DEL_SEM_LEAVE(ercd);
return(ercd);
}
ER
sig_sem(ID semid)
{
SEMCB *p_semcb;
TCB *p_tcb;
ER ercd;
LOG_SIG_SEM_ENTER(semid);
CHECK_TSKCTX_UNL();
CHECK_SEMID(semid);
p_semcb = get_semcb(semid);
t_lock_cpu();
if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_semcb->p_seminib->acvct.acptn1)) {
ercd = E_OACV;
}
else if (!queue_empty(&(p_semcb->wait_queue))) {
p_tcb = (TCB *) queue_delete_next(&(p_semcb->wait_queue));
if (wait_complete(p_tcb)) {
dispatch();
}
ercd = E_OK;
}
else if (p_semcb->semcnt < p_semcb->p_seminib->maxsem) {
p_semcb->semcnt += 1;
ercd = E_OK;
}
else {
ercd = E_QOVR;
}
t_unlock_cpu();
error_exit:
LOG_SIG_SEM_LEAVE(ercd);
return(ercd);
}
static ER
lsig_sem(ID semid)
{
SEMCB *p_semcb;
TCB *p_tcb;
ER ercd;
// LOG_ISIG_SEM_ENTER(semid);
// CHECK_INTCTX_UNL();
// CHECK_SEMID(semid);
p_semcb = get_semcb(semid);
i_lock_cpu();
/* if (p_semcb->p_seminib->sematr == TA_NOEXS) {
ercd = E_NOEXS;
}
else*/ if (!queue_empty(&(p_semcb->wait_queue))) {
p_tcb = (TCB *) queue_delete_next(&(p_semcb->wait_queue));
if (wait_complete(p_tcb)) {
reqflg = true;
}
ercd = E_OK;
}
else if (p_semcb->semcnt < p_semcb->p_seminib->maxsem) {
p_semcb->semcnt += 1;
ercd = E_OK;
}
else {
ercd = E_QOVR;
}
i_unlock_cpu();
// error_exit:
// LOG_ISIG_SEM_LEAVE(ercd);
return(ercd);
}
/*
* Get object name from control block
*/
EXPORT ER knl_semaphore_getname(ID id, UB **name)
{
SEMCB *semcb;
ER ercd = E_OK;
CHECK_SEMID(id);
BEGIN_DISABLE_INTERRUPT;
semcb = get_semcb(id);
if ( semcb->semid == 0 ) {
ercd = E_NOEXS;
goto error_exit;
}
if ( (semcb->sematr & TA_DSNAME) == 0 ) {
ercd = E_OBJ;
goto error_exit;
}
*name = semcb->name;
error_exit:
END_DISABLE_INTERRUPT;
return ercd;
}
/*
* Delete semaphore
*/
SYSCALL ER tk_del_sem_impl( ID semid )
{
SEMCB *semcb;
ER ercd = E_OK;
CHECK_SEMID(semid);
semcb = get_semcb(semid);
BEGIN_CRITICAL_SECTION;
if ( semcb->semid == 0 ) {
ercd = E_NOEXS;
} else {
/* Release wait state of task (E_DLT) */
knl_wait_delete(&semcb->wait_queue);
/* Return to FreeQue */
QueInsert(&semcb->wait_queue, &knl_free_semcb);
semcb->semid = 0;
}
END_CRITICAL_SECTION;
return ercd;
}
