ER
twai_flg(ID flgid, FLGPTN waiptn, MODE wfmode, FLGPTN *p_flgptn, TMO tmout)
{
FLGCB *p_flgcb;
WINFO_FLG *p_winfo_flg;
ER ercd;
PCB *my_p_pcb;
TCB *p_runtsk;
LOG_TWAI_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn, tmout);
CHECK_TSKCTX_UNL();
CHECK_FLGID(flgid);
CHECK_PAR(waiptn != 0U);
CHECK_PAR(wfmode == TWF_ORW || wfmode == TWF_ANDW);
CHECK_TMOUT(tmout);
p_flgcb = get_flgcb(flgid);
t_lock_cpu();
my_p_pcb = get_my_p_pcb();
T_CHECK_DISPATCH(my_p_pcb);
retry:
t_acquire_obj_lock(&GET_OBJLOCK(p_flgcb));
if ((p_flgcb->p_flginib->flgatr & TA_WMUL) == 0U
&& !queue_empty(&(p_flgcb->wait_queue))) {
release_obj_lock(&GET_OBJLOCK(p_flgcb));
ercd = E_ILUSE;
}
else if (check_flg_cond(p_flgcb, waiptn, wfmode, p_flgptn)) {
release_obj_lock(&GET_OBJLOCK(p_flgcb));
ercd = E_OK;
}
else if (tmout == TMO_POL) {
release_obj_lock(&GET_OBJLOCK(p_flgcb));
ercd = E_TMOUT;
}
else {
if ((my_p_pcb = t_acquire_nested_tsk_lock_self(&GET_OBJLOCK(p_flgcb))) == NULL){
goto retry;
}
p_runtsk = my_p_pcb->p_runtsk;
p_winfo_flg = (WINFO_FLG *)(&(p_runtsk->winfo_obj));
p_winfo_flg->waiptn = waiptn;
p_winfo_flg->wfmode = wfmode;
p_runtsk->tstat = (TS_WAITING | TS_WAIT_FLG);
wobj_make_wait_tmout((WOBJCB *) p_flgcb, tmout, p_runtsk);
release_nested_tsk_lock(my_p_pcb);
release_obj_lock(&GET_OBJLOCK(p_flgcb));
dispatch();
ercd = p_runtsk->wercd;
if (ercd == E_OK) {
*p_flgptn = p_winfo_flg->flgptn;
}
}
t_unlock_cpu();
error_exit:
LOG_TWAI_FLG_LEAVE(ercd, *p_flgptn);
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);
p_flgcb = get_flgcb(flgid);
t_lock_cpu();
if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
ercd = E_NOEXS;
}
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
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
set_flg(ID flgid, FLGPTN setptn)
{
FLGCB *p_flgcb;
QUEUE *p_queue;
TCB *p_tcb;
WINFO_FLG *p_winfo_flg;
ER ercd;
bool_t dspreq = false;
PCB *p_pcb;
LOG_SET_FLG_ENTER(flgid, setptn);
CHECK_TSKCTX_UNL();
CHECK_FLGID(flgid);
p_flgcb = get_flgcb(flgid);
t_lock_cpu();
t_acquire_obj_lock(&GET_OBJLOCK(p_flgcb));
p_flgcb->flgptn |= setptn;
p_queue = p_flgcb->wait_queue.p_next;
while (p_queue != &(p_flgcb->wait_queue)) {
p_tcb = (TCB *) p_queue;
p_queue = p_queue->p_next;
/* フラグのセットを非破壊コードにできないため，リトライしない */
p_pcb = acquire_nested_tsk_lock_without_preemption(p_tcb);
p_winfo_flg = (WINFO_FLG *)(&(p_tcb->winfo_obj));
if (check_flg_cond(p_flgcb, p_winfo_flg->waiptn,
p_winfo_flg->wfmode, &(p_winfo_flg->flgptn))) {
queue_delete(&(p_tcb->task_queue));
if (wait_complete(p_tcb)) {
if (dispatch_request(p_pcb)) {
dspreq = true;
}
}
if ((p_flgcb->p_flginib->flgatr & TA_CLR) != 0U) {
release_nested_tsk_lock(p_pcb);
break;
}
}
release_nested_tsk_lock(p_pcb);
}
ercd = E_OK;
release_obj_lock(&GET_OBJLOCK(p_flgcb));
if (dspreq) {
dispatch();
}
t_unlock_cpu();
error_exit:
LOG_SET_FLG_LEAVE(ercd);
return(ercd);
}
ER
set_flg(ID flgid, FLGPTN setptn)
{
FLGCB *p_flgcb;
QUEUE *p_queue;
TCB *p_tcb;
WINFO_FLG *p_winfo_flg;
bool_t dspreq = false;
ER ercd;
LOG_SET_FLG_ENTER(flgid, setptn);
CHECK_TSKCTX_UNL();
CHECK_FLGID(flgid);
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.acptn1)) {
ercd = E_OACV;
}
else {
p_flgcb->flgptn |= setptn;
p_queue = p_flgcb->wait_queue.p_next;
while (p_queue != &(p_flgcb->wait_queue)) {
p_tcb = (TCB *) p_queue;
p_queue = p_queue->p_next;
p_winfo_flg = (WINFO_FLG *)(p_tcb->p_winfo);
if (check_flg_cond(p_flgcb, p_winfo_flg->waiptn,
p_winfo_flg->wfmode, &(p_winfo_flg->flgptn))) {
queue_delete(&(p_tcb->task_queue));
if (wait_complete(p_tcb)) {
dspreq = true;
}
if ((p_flgcb->p_flginib->flgatr & TA_CLR) != 0U) {
break;
}
}
}
if (dspreq) {
dispatch();
}
ercd = E_OK;
}
t_unlock_cpu();
error_exit:
LOG_SET_FLG_LEAVE(ercd);
return(ercd);
}
ER
iset_flg(ID flgid, FLGPTN setptn)
{
FLGCB *p_flgcb;
QUEUE *p_queue;
TCB *p_tcb;
WINFO_FLG *p_winfo_flg;
ER ercd;
LOG_ISET_FLG_ENTER(flgid, setptn);
CHECK_INTCTX_UNL();
CHECK_FLGID(flgid);
p_flgcb = get_flgcb(flgid);
i_lock_cpu();
if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
ercd = E_NOEXS;
}
else {
p_flgcb->flgptn |= setptn;
p_queue = p_flgcb->wait_queue.p_next;
while (p_queue != &(p_flgcb->wait_queue)) {
p_tcb = (TCB *) p_queue;
p_queue = p_queue->p_next;
p_winfo_flg = (WINFO_FLG *)(p_tcb->p_winfo);
if (check_flg_cond(p_flgcb, p_winfo_flg->waiptn,
p_winfo_flg->wfmode, &(p_winfo_flg->flgptn))) {
queue_delete(&(p_tcb->task_queue));
if (wait_complete(p_tcb)) {
reqflg = true;
}
if ((p_flgcb->p_flginib->flgatr & TA_CLR) != 0U) {
break;
}
}
}
ercd = E_OK;
}
i_unlock_cpu();
error_exit:
LOG_ISET_FLG_LEAVE(ercd);
return(ercd);
}
ER
wai_flg(ID flgid, FLGPTN waiptn, MODE wfmode, FLGPTN *p_flgptn)
{
FLGCB *p_flgcb;
WINFO_FLG winfo_flg;
ER ercd;
LOG_WAI_FLG_ENTER(flgid, waiptn, wfmode, p_flgptn);
CHECK_DISPATCH();
CHECK_FLGID(flgid);
CHECK_PAR(waiptn != 0U);
CHECK_PAR(wfmode == TWF_ORW || wfmode == TWF_ANDW);
p_flgcb = get_flgcb(flgid);
t_lock_cpu();
if (p_flgcb->p_flginib->flgatr == TA_NOEXS) {
ercd = E_NOEXS;
}
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 {
winfo_flg.waiptn = waiptn;
winfo_flg.wfmode = wfmode;
p_runtsk->tstat = (TS_WAITING | TS_WAIT_FLG);
wobj_make_wait((WOBJCB *) p_flgcb, (WINFO_WOBJ *) &winfo_flg);
dispatch();
ercd = winfo_flg.winfo.wercd;
if (ercd == E_OK) {
*p_flgptn = winfo_flg.flgptn;
}
}
t_unlock_cpu();
error_exit:
LOG_WAI_FLG_LEAVE(ercd, *p_flgptn);
return(ercd);
}
