ER
trcv_pdq(ID pdqid, intptr_t *p_data, PRI *p_datapri, TMO tmout)
{
PDQCB *p_pdqcb;
WINFO_PDQ winfo_pdq;
TMEVTB tmevtb;
bool_t dspreq;
ER ercd;
LOG_TRCV_PDQ_ENTER(pdqid, p_data, p_datapri, tmout);
CHECK_DISPATCH();
CHECK_PDQID(pdqid);
CHECK_MACV_WRITE(p_data, intptr_t);
CHECK_MACV_WRITE(p_datapri, PRI);
CHECK_TMOUT(tmout);
p_pdqcb = get_pdqcb(pdqid);
t_lock_cpu();
if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_pdqcb->p_pdqinib->acvct.acptn2)) {
ercd = E_OACV;
}
else if (receive_pridata(p_pdqcb, p_data, p_datapri, &dspreq)) {
if (dspreq) {
dispatch();
}
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_RPDQ);
make_wait_tmout(&(winfo_pdq.winfo), &tmevtb, tmout);
queue_insert_prev(&(p_pdqcb->rwait_queue), &(p_runtsk->task_queue));
winfo_pdq.p_pdqcb = p_pdqcb;
LOG_TSKSTAT(p_runtsk);
dispatch();
ercd = winfo_pdq.winfo.wercd;
if (ercd == E_OK) {
*p_data = winfo_pdq.data;
*p_datapri = winfo_pdq.datapri;
}
}
t_unlock_cpu();
error_exit:
LOG_TRCV_PDQ_LEAVE(ercd, *p_data, *p_datapri);
return(ercd);
}
ER
ref_mtx(ID mtxid, T_RMTX *pk_rmtx)
{
MTXCB *p_mtxcb;
ER ercd;
LOG_REF_MTX_ENTER(mtxid, pk_rmtx);
CHECK_TSKCTX_UNL();
CHECK_ID(VALID_MTXID(mtxid));
CHECK_MACV_WRITE(pk_rmtx, T_RMTX);
p_mtxcb = get_mtxcb(mtxid);
lock_cpu();
if (p_mtxcb->p_mtxinib->mtxatr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_mtxcb->p_mtxinib->acvct.acptn4)) {
ercd = E_OACV;
}
else {
pk_rmtx->htskid = (p_mtxcb->p_loctsk != NULL) ?
TSKID(p_mtxcb->p_loctsk) : TSK_NONE;
pk_rmtx->wtskid = wait_tskid(&(p_mtxcb->wait_queue));
ercd = E_OK;
}
unlock_cpu();
error_exit:
LOG_REF_MTX_LEAVE(ercd, pk_rmtx);
return(ercd);
}
ER
ref_mbf(ID mbfid, T_RMBF *pk_rmbf)
{
MBFCB *p_mbfcb;
ER ercd;
LOG_REF_MBF_ENTER(mbfid, pk_rmbf);
CHECK_TSKCTX_UNL();
CHECK_ID(VALID_MBFID(mbfid));
CHECK_MACV_WRITE(pk_rmbf, T_RMBF);
p_mbfcb = get_mbfcb(mbfid);
lock_cpu();
if (p_mbfcb->p_mbfinib->mbfatr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_mbfcb->p_mbfinib->acvct.acptn4)) {
ercd = E_OACV;
}
else {
pk_rmbf->stskid = wait_tskid(&(p_mbfcb->swait_queue));
pk_rmbf->rtskid = wait_tskid(&(p_mbfcb->rwait_queue));
pk_rmbf->smbfcnt = p_mbfcb->smbfcnt;
pk_rmbf->fmbfsz = p_mbfcb->fmbfsz;
ercd = E_OK;
}
unlock_cpu();
error_exit:
LOG_REF_MBF_LEAVE(ercd, pk_rmbf);
return(ercd);
}
ER
ref_flg(ID flgid, T_RFLG *pk_rflg)
{
FLGCB *p_flgcb;
ER ercd;
LOG_REF_FLG_ENTER(flgid, pk_rflg);
CHECK_TSKCTX_UNL();
CHECK_FLGID(flgid);
CHECK_MACV_WRITE(pk_rflg, T_RFLG);
p_flgcb = get_flgcb(flgid);
t_lock_cpu();
if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_flgcb->p_flginib->acvct.acptn4)) {
ercd = E_OACV;
}
else {
pk_rflg->wtskid = wait_tskid(&(p_flgcb->wait_queue));
pk_rflg->flgptn = p_flgcb->flgptn;
ercd = E_OK;
}
t_unlock_cpu();
error_exit:
LOG_REF_FLG_LEAVE(ercd, pk_rflg);
return(ercd);
}
ER
get_pri(ID tskid, PRI *p_tskpri)
{
TCB *p_tcb;
ER ercd;
LOG_GET_PRI_ENTER(tskid, p_tskpri);
CHECK_TSKCTX_UNL();
CHECK_TSKID_SELF(tskid);
CHECK_MACV_WRITE(p_tskpri, PRI);
p_tcb = get_tcb_self(tskid);
t_lock_cpu();
if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_tcb->p_tinib->acvct.acptn4)) {
ercd = E_OACV;
}
else if (TSTAT_DORMANT(p_tcb->tstat)) {
ercd = E_OBJ;
}
else {
*p_tskpri = EXT_TSKPRI(p_tcb->priority);
ercd = E_OK;
}
t_unlock_cpu();
error_exit:
LOG_GET_PRI_LEAVE(ercd, *p_tskpri);
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_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
ref_pdq(ID pdqid, T_RPDQ *pk_rpdq)
{
PDQCB *p_pdqcb;
ER ercd;
LOG_REF_PDQ_ENTER(pdqid, pk_rpdq);
CHECK_TSKCTX_UNL();
CHECK_PDQID(pdqid);
CHECK_MACV_WRITE(pk_rpdq, T_RPDQ);
p_pdqcb = get_pdqcb(pdqid);
t_lock_cpu();
if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_pdqcb->p_pdqinib->acvct.acptn4)) {
ercd = E_OACV;
}
else {
pk_rpdq->stskid = wait_tskid(&(p_pdqcb->swait_queue));
pk_rpdq->rtskid = wait_tskid(&(p_pdqcb->rwait_queue));
pk_rpdq->spdqcnt = p_pdqcb->count;
ercd = E_OK;
}
t_unlock_cpu();
error_exit:
LOG_REF_PDQ_LEAVE(ercd, pk_rpdq);
return(ercd);
}
ER
twai_flg(ID flgid, FLGPTN waiptn, MODE wfmode, FLGPTN *p_flgptn, TMO tmout)
{
FLGCB *p_flgcb;
WINFO_FLG winfo_flg;
TMEVTB tmevtb;
ER ercd;
LOG_TWAI_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn, tmout);
CHECK_DISPATCH();
CHECK_FLGID(flgid);
CHECK_PAR(waiptn != 0U);
CHECK_PAR(wfmode == TWF_ORW || wfmode == TWF_ANDW);
CHECK_MACV_WRITE(p_flgptn, FLGPTN);
CHECK_TMOUT(tmout);
p_flgcb = get_flgcb(flgid);
t_lock_cpu();
if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_flgcb->p_flginib->acvct.acptn2)) {
ercd = E_OACV;
}
else if ((p_flgcb->p_flginib->flgatr & TA_WMUL) == 0U
&& !queue_empty(&(p_flgcb->wait_queue))) {
ercd = E_ILUSE;
}
else if (check_flg_cond(p_flgcb, waiptn, wfmode, p_flgptn)) {
ercd = E_OK;
}
else if (tmout == TMO_POL) {
ercd = E_TMOUT;
}
else if (p_runtsk->waifbd) {
ercd = E_RLWAI;
}
else {
winfo_flg.waiptn = waiptn;
winfo_flg.wfmode = wfmode;
p_runtsk->tstat = (TS_WAITING | TS_WAIT_FLG);
wobj_make_wait_tmout((WOBJCB *) p_flgcb, (WINFO_WOBJ *) &winfo_flg,
&tmevtb, tmout);
dispatch();
ercd = winfo_flg.winfo.wercd;
if (ercd == E_OK) {
*p_flgptn = winfo_flg.flgptn;
}
}
t_unlock_cpu();
error_exit:
LOG_TWAI_FLG_LEAVE(ercd, *p_flgptn);
return(ercd);
}
ER
prcv_pdq(ID pdqid, intptr_t *p_data, PRI *p_datapri)
{
PDQCB *p_pdqcb;
bool_t dspreq;
ER ercd;
LOG_PRCV_PDQ_ENTER(pdqid, p_data, p_datapri);
CHECK_TSKCTX_UNL();
CHECK_PDQID(pdqid);
CHECK_MACV_WRITE(p_data, intptr_t);
CHECK_MACV_WRITE(p_datapri, PRI);
p_pdqcb = get_pdqcb(pdqid);
t_lock_cpu();
if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_pdqcb->p_pdqinib->acvct.acptn2)) {
ercd = E_OACV;
}
else if (receive_pridata(p_pdqcb, p_data, p_datapri, &dspreq)) {
if (dspreq) {
dispatch();
}
ercd = E_OK;
}
else {
ercd = E_TMOUT;
}
t_unlock_cpu();
error_exit:
LOG_PRCV_PDQ_LEAVE(ercd, *p_data, *p_datapri);
return(ercd);
}
ER
get_inf(intptr_t *p_exinf)
{
ER ercd;
LOG_GET_INF_ENTER(p_exinf);
CHECK_TSKCTX_UNL();
CHECK_MACV_WRITE(p_exinf, intptr_t);
t_lock_cpu();
*p_exinf = p_runtsk->p_tinib->exinf;
ercd = E_OK;
t_unlock_cpu();
error_exit:
LOG_GET_INF_LEAVE(ercd, *p_exinf);
return(ercd);
}
ER
get_tid(ID *p_tskid)
{
ER ercd;
LOG_GET_TID_ENTER(p_tskid);
CHECK_TSKCTX_UNL();
CHECK_MACV_WRITE(p_tskid, ID);
t_lock_cpu();
*p_tskid = TSKID(p_runtsk);
ercd = E_OK;
t_unlock_cpu();
error_exit:
LOG_GET_TID_LEAVE(ercd, *p_tskid);
return(ercd);
}
ER
get_did(ID *p_domid)
{
ER ercd;
LOG_GET_DID_ENTER(p_domid);
CHECK_TSKCTX_UNL();
CHECK_MACV_WRITE(p_domid, ID);
t_lock_cpu();
*p_domid = DOMID(p_runtsk->p_tinib->p_dominib);
ercd = E_OK;
t_unlock_cpu();
error_exit:
LOG_GET_DID_LEAVE(ercd, *p_domid);
return(ercd);
}
ER
get_ipm(PRI *p_intpri)
{
ER ercd;
LOG_GET_IPM_ENTER(p_intpri);
CHECK_TSKCTX_UNL();
CHECK_MACV_WRITE(p_intpri, PRI);
CHECK_ACPTN(sysstat_acvct.acptn4);
t_lock_cpu();
*p_intpri = t_get_ipm();
ercd = E_OK;
t_unlock_cpu();
error_exit:
LOG_GET_IPM_LEAVE(ercd, *p_intpri);
return(ercd);
}
ER
ref_ovr(ID tskid, T_ROVR *pk_rovr)
{
TCB *p_tcb;
ER ercd;
LOG_REF_OVR_ENTER(tskid, pk_rovr);
CHECK_TSKCTX_UNL();
CHECK_OBJ(ovrinib.ovrhdr != NULL);
CHECK_TSKID_SELF(tskid);
CHECK_MACV_WRITE(pk_rovr, T_ROVR);
p_tcb = get_tcb_self(tskid);
t_lock_cpu();
if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_tcb->p_tinib->acvct.acptn4)) {
ercd = E_OACV;
}
else {
if (p_tcb->leftotm > 0U) {
pk_rovr->ovrstat = TOVR_STA;
if (p_tcb == p_runtsk) {
pk_rovr->leftotm = target_ovrtimer_get_current();
}
else {
pk_rovr->leftotm = p_tcb->leftotm;
}
}
else {
pk_rovr->ovrstat = TOVR_STP;
}
ercd = E_OK;
}
t_unlock_cpu();
error_exit:
LOG_REF_OVR_LEAVE(ercd, pk_rovr);
return(ercd);
}
ER
pol_flg(ID flgid, FLGPTN waiptn, MODE wfmode, FLGPTN *p_flgptn)
{
FLGCB *p_flgcb;
ER ercd;
LOG_POL_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn);
CHECK_TSKCTX_UNL();
CHECK_FLGID(flgid);
CHECK_PAR(waiptn != 0U);
CHECK_PAR(wfmode == TWF_ORW || wfmode == TWF_ANDW);
CHECK_MACV_WRITE(p_flgptn, FLGPTN);
p_flgcb = get_flgcb(flgid);
t_lock_cpu();
if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
ercd = E_NOEXS;
}
else if (VIOLATE_ACPTN(p_flgcb->p_flginib->acvct.acptn2)) {
ercd = E_OACV;
}
else if ((p_flgcb->p_flginib->flgatr & TA_WMUL) == 0U
&& !queue_empty(&(p_flgcb->wait_queue))) {
ercd = E_ILUSE;
}
else if (check_flg_cond(p_flgcb, waiptn, wfmode, p_flgptn)) {
ercd = E_OK;
}
else {
ercd = E_TMOUT;
}
t_unlock_cpu();
error_exit:
LOG_POL_FLG_LEAVE(ercd, *p_flgptn);
return(ercd);
}
ER
ref_tsk(ID tskid, T_RTSK *pk_rtsk)
{
TCB *p_tcb;
uint_t tstat;
ER ercd;
LOG_REF_TSK_ENTER(tskid, pk_rtsk);
CHECK_TSKCTX_UNL();
CHECK_TSKID_SELF(tskid);
CHECK_MACV_WRITE(pk_rtsk, T_RTSK);
p_tcb = get_tcb_self(tskid);
CHECK_ACPTN(p_tcb->p_tinib->acvct.acptn4);
t_lock_cpu();
tstat = p_tcb->tstat;
if (TSTAT_DORMANT(tstat)) {
/*
* 対象タスクが休止状態の場合
*/
pk_rtsk->tskstat = TTS_DMT;
}
else {
/*
* タスク状態の取出し
*/
if (TSTAT_SUSPENDED(tstat)) {
if (TSTAT_WAITING(tstat)) {
pk_rtsk->tskstat = TTS_WAS;
}
else {
pk_rtsk->tskstat = TTS_SUS;
}
}
else if (TSTAT_WAITING(tstat)) {
pk_rtsk->tskstat = TTS_WAI;
}
else if (p_tcb == p_runtsk) {
pk_rtsk->tskstat = TTS_RUN;
}
else {
pk_rtsk->tskstat = TTS_RDY;
}
/*
* 現在優先度とベース優先度の取出し
*/
pk_rtsk->tskpri = EXT_TSKPRI(p_tcb->priority);
pk_rtsk->tskbpri = EXT_TSKPRI(p_tcb->bpriority);
if (TSTAT_WAITING(tstat)) {
/*
* 待ち要因と待ち対象のオブジェクトのIDの取出し
*/
switch (tstat & TS_WAIT_MASK) {
case TS_WAIT_SLP:
pk_rtsk->tskwait = TTW_SLP;
break;
case TS_WAIT_DLY:
pk_rtsk->tskwait = TTW_DLY;
break;
case TS_WAIT_SEM:
pk_rtsk->tskwait = TTW_SEM;
pk_rtsk->wobjid = SEMID(((WINFO_SEM *)(p_tcb->p_winfo))
->p_semcb);
break;
case TS_WAIT_FLG:
pk_rtsk->tskwait = TTW_FLG;
pk_rtsk->wobjid = FLGID(((WINFO_FLG *)(p_tcb->p_winfo))
->p_flgcb);
break;
case TS_WAIT_SDTQ:
pk_rtsk->tskwait = TTW_SDTQ;
pk_rtsk->wobjid = DTQID(((WINFO_DTQ *)(p_tcb->p_winfo))
->p_dtqcb);
break;
case TS_WAIT_RDTQ:
pk_rtsk->tskwait = TTW_RDTQ;
pk_rtsk->wobjid = DTQID(((WINFO_DTQ *)(p_tcb->p_winfo))
->p_dtqcb);
break;
case TS_WAIT_SPDQ:
pk_rtsk->tskwait = TTW_SPDQ;
pk_rtsk->wobjid = PDQID(((WINFO_PDQ *)(p_tcb->p_winfo))
->p_pdqcb);
break;
case TS_WAIT_RPDQ:
pk_rtsk->tskwait = TTW_RPDQ;
pk_rtsk->wobjid = PDQID(((WINFO_PDQ *)(p_tcb->p_winfo))
->p_pdqcb);
break;
case TS_WAIT_MTX:
pk_rtsk->tskwait = TTW_MTX;
pk_rtsk->wobjid = MTXID(((WINFO_MTX *)(p_tcb->p_winfo))
->p_mtxcb);
break;
case TS_WAIT_SMBF:
pk_rtsk->tskwait = TTW_SMBF;
pk_rtsk->wobjid = MBFID(((WINFO_MBF *)(p_tcb->p_winfo))
->p_mbfcb);
break;
case TS_WAIT_RMBF:
pk_rtsk->tskwait = TTW_RMBF;
pk_rtsk->wobjid = MBFID(((WINFO_MBF *)(p_tcb->p_winfo))
->p_mbfcb);
break;
case TS_WAIT_MPF:
pk_rtsk->tskwait = TTW_MPF;
pk_rtsk->wobjid = MPFID(((WINFO_MPF *)(p_tcb->p_winfo))
->p_mpfcb);
break;
}
/*
* タイムアウトするまでの時間の取出し
*/
if (p_tcb->p_winfo->p_tmevtb != NULL) {
pk_rtsk->lefttmo
= (TMO) tmevt_lefttim(p_tcb->p_winfo->p_tmevtb);
}
else {
pk_rtsk->lefttmo = TMO_FEVR;
}
}
/*
* 起床要求キューイング数の取出し
*/
pk_rtsk->wupcnt = p_tcb->wupque ? 1U : 0U;
/*
* タスク例外マスク状態か否かの取出し
*/
pk_rtsk->texmsk = t_sense_texmask(p_tcb);
/*
* 待ち禁止状態か否かの取出し
*/
pk_rtsk->waifbd = p_tcb->waifbd;
/*
* 拡張サービスコールのネストレベルの取出し
*/
pk_rtsk->svclevel = p_tcb->svclevel;
}
/*
* 起動要求キューイング数の取出し
*/
pk_rtsk->actcnt = p_tcb->actque ? 1U : 0U;
ercd = E_OK;
t_unlock_cpu();
error_exit:
LOG_REF_TSK_LEAVE(ercd, pk_rtsk);
return(ercd);
}
