ER
dis_int(INTNO intno)
{
bool_t locked;
ER ercd;
LOG_DIS_INT_ENTER(intno);
CHECK_TSKCTX();
CHECK_INTNO_DISINT(intno);
CHECK_ACPTN(sysstat_acvct.acptn2);
locked = t_sense_lock();
if (!locked) {
t_lock_cpu();
}
if (t_disable_int(intno)) {
ercd = E_OK;
}
else {
ercd = E_OBJ;
}
if (!locked) {
t_unlock_cpu();
}
error_exit:
LOG_DIS_INT_LEAVE(ercd);
return(ercd);
}
ER
ena_int(INTNO intno)
{
bool_t locked;
ER ercd;
LOG_ENA_INT_ENTER(intno);
CHECK_TSKCTX();
CHECK_INTNO_DISINT(intno);
locked = t_sense_lock();
if (!locked) {
t_lock_cpu();
}
if (t_enable_int(intno)) {
ercd = E_OK;
}
else {
ercd = E_OBJ;
}
if (!locked) {
t_unlock_cpu();
}
error_exit:
LOG_ENA_INT_LEAVE(ercd);
return(ercd);
}
ER
chg_ipm(PRI intpri)
{
bool_t locked;
ER ercd;
LOG_CHG_IPM_ENTER(intpri);
CHECK_TSKCTX();
CHECK_INTPRI_CHGIPM(intpri);
locked = t_sense_lock();
if (!locked) {
t_lock_cpu();
}
t_set_ipm(intpri);
if (intpri != TIPM_ENAALL) {
dspflg = false;
}
else if (!disdsp) {
dspflg = true;
if (p_runtsk != p_schedtsk) {
dispatch();
}
}
ercd = E_OK;
if (!locked) {
t_unlock_cpu();
}
error_exit:
LOG_CHG_IPM_LEAVE(ercd);
return(ercd);
}
bool_t
sns_dpn(void)
{
bool_t state;
LOG_SNS_DPN_ENTER();
state = (sense_context() || t_sense_lock() || !dspflg) ? true : false;
LOG_SNS_DPN_LEAVE(state);
return(state);
}
ER
ext_tsk(void)
{
ER ercd;
LOG_EXT_TSK_ENTER();
CHECK_TSKCTX();
if (t_sense_lock()) {
/*
* CPUロック状態でext_tskが呼ばれた場合は，CPUロックを解除し
* てからタスクを終了する．実装上は，サービスコール内でのCPU
* ロックを省略すればよいだけ．
*/
}
else {
t_lock_cpu();
}
if (disdsp) {
/*
* ディスパッチ禁止状態でext_tskが呼ばれた場合は，ディスパッ
* チ許可状態にしてからタスクを終了する．
*/
disdsp = false;
}
if (!ipmflg) {
/*
* 割込み優先度マスク（IPM）がTIPM_ENAALL以外の状態でext_tsk
* が呼ばれた場合は，IPMをTIPM_ENAALLにしてからタスクを終了す
* る．
*/
t_set_ipm(TIPM_ENAALL);
ipmflg = true;
}
dspflg = true;
(void) make_non_runnable(p_runtsk);
if (!queue_empty(&(p_runtsk->mutex_queue))) {
(void) (*mtxhook_release_all)(p_runtsk);
}
#ifdef TOPPERS_SUPPORT_OVRHDR
ovrtimer_stop();
#endif /* TOPPERS_SUPPORT_OVRHDR */
make_dormant(p_runtsk);
if (p_runtsk->actque) {
p_runtsk->actque = false;
(void) make_active(p_runtsk);
}
exit_and_dispatch();
ercd = E_SYS;
error_exit:
LOG_EXT_TSK_LEAVE(ercd);
return(ercd);
}
ER
ext_tsk(void)
{
ER ercd;
LOG_EXT_TSK_ENTER();
CHECK_TSKCTX();
if (t_sense_lock()) {
/*
* CPUロック状態でext_tskが呼ばれた場合は，CPUロックを解除し
* てからタスクを終了する．実装上は，サービスコール内でのCPU
* ロックを省略すればよいだけ．
*/
}
else {
t_lock_cpu();
}
if (disdsp) {
/*
* ディスパッチ禁止状態でext_tskが呼ばれた場合は，ディスパッ
* チ許可状態にしてからタスクを終了する．
*/
disdsp = false;
}
if (t_get_ipm() != TIPM_ENAALL) {
/*
* 割込み優先度マスク（IPM）がTIPM_ENAALL以外の状態でext_tsk
* が呼ばれた場合は，IPMをTIPM_ENAALLにしてからタスクを終了す
* る．
*/
t_set_ipm(TIPM_ENAALL);
}
dspflg = true;
(void) make_non_runnable(p_runtsk);
make_dormant(p_runtsk);
if (p_runtsk->actque) {
p_runtsk->actque = false;
(void) make_active(p_runtsk);
}
exit_and_dispatch();
return(E_SYS);
error_exit:
LOG_EXT_TSK_LEAVE(ercd);
return(ercd);
}
ER
unl_cpu(void)
{
ER ercd;
LOG_UNL_CPU_ENTER();
CHECK_TSKCTX();
if (t_sense_lock()) {
t_unlock_cpu();
}
ercd = E_OK;
error_exit:
LOG_UNL_CPU_LEAVE(ercd);
return(ercd);
}
ER
loc_cpu(void)
{
ER ercd;
LOG_LOC_CPU_ENTER();
CHECK_TSKCTX();
if (!t_sense_lock()) {
t_lock_cpu();
}
ercd = E_OK;
error_exit:
LOG_LOC_CPU_LEAVE(ercd);
return(ercd);
}
ER
unl_cpu(void)
{
ER ercd;
LOG_UNL_CPU_ENTER();
CHECK_TSKCTX();
if (t_sense_lock() && ((get_my_p_pcb())->locspnid == 0)) {
t_unlock_cpu();
}
ercd = E_OK;
error_exit:
LOG_UNL_CPU_LEAVE(ercd);
return(ercd);
}
bool_t
sns_dsp(void)
{
bool_t state;
bool_t locked;
LOG_SNS_DSP_ENTER();
locked = t_sense_lock();
if (!locked) {
t_lock_cpu();
}
state = (get_my_p_pcb())->disdsp;
if (!locked) {
t_unlock_cpu();
}
LOG_SNS_DSP_LEAVE(state);
return(state);
}
ER
unl_cpu(void)
{
ER ercd;
LOG_UNL_CPU_ENTER();
CHECK_TSKCTX();
CHECK_ACPTN(sysstat_acvct.acptn2);
if (t_sense_lock()) {
if (p_runtsk->enatex && p_runtsk->texptn != 0U && ipmflg
&& rundom == TACP_KERNEL && p_runtsk->svclevel == 0U) {
call_texrtn_stask();
}
t_unlock_cpu();
}
ercd = E_OK;
error_exit:
LOG_UNL_CPU_LEAVE(ercd);
return(ercd);
}
ER
get_ipm(PRI *p_intpri)
{
bool_t locked;
ER ercd;
LOG_GET_IPM_ENTER(p_intpri);
CHECK_TSKCTX();
locked = t_sense_lock();
if (!locked) {
t_lock_cpu();
}
*p_intpri = t_get_ipm();
ercd = E_OK;
if (!locked) {
t_unlock_cpu();
}
error_exit:
LOG_GET_IPM_LEAVE(ercd, *p_intpri);
return(ercd);
}
bool_t
sns_dpn(void)
{
bool_t state;
bool_t locked;
LOG_SNS_DPN_ENTER();
/*
* PCBへアクセスするためCPUロック状態とする
*/
locked = t_sense_lock();
if (!locked) {
t_lock_cpu();
}
state = (sense_context() || locked || !((get_my_p_pcb())->dspflg)) ? true : false;
if (!locked) {
t_unlock_cpu();
}
LOG_SNS_DPN_LEAVE(state);
return(state);
}
ER
ext_tsk(void)
{
ER ercd;
PCB *t_p_pcb;
PCB *my_p_pcb;
TCB *p_runtsk;
bool_t locked;
LOG_EXT_TSK_ENTER();
CHECK_TSKCTX();
/*
* CPUロック状態でext_tskが呼ばれた場合は，ロック取得時に割込みを許可
* しない.
* ロック取得時に割込みを許可しないのは， 過度状態の場合にロックを取得
* できなかった場合に割込みを許可すると，割込みが入りサスペンド状態と
* なってしまうためである．
*/
locked = t_sense_lock();
retry:
if (locked) {
my_p_pcb = acquire_tsk_lock_without_preemption_self();
}
else {
t_lock_cpu();
my_p_pcb = t_acquire_tsk_lock_self_without_runnable_check();
}
p_runtsk = my_p_pcb->p_runtsk;
/* 再起動時のマイグレーションなし */
if ((p_runtsk->actprc == TPRC_NONE) || (p_runtsk->actprc == my_p_pcb->prcid)) {
/*
* ディスパッチ禁止状態でext_tskが呼ばれた場合に対応して，ディスパッ
* チ許可状態にしてからタスクを終了する．
*/
my_p_pcb->disdsp = false;
/*
* 割込み優先度マスク（IPM）がTIPM_ENAALL以外の状態でext_tskが呼ばれ
* た場合に対応して，IPMをTIPM_ENAALLにしてからタスクを終了する．
*/
t_set_ipm(TIPM_ENAALL);
my_p_pcb->ipmflg = true;
my_p_pcb->dspflg = true;
/*
* スピンロックを取得している場合は，スピンロックを解除する
*/
force_unlock_spin(my_p_pcb);
(void) make_non_runnable(p_runtsk);
make_dormant(p_runtsk);
if (p_runtsk->actque) {
p_runtsk->actque = false;
p_runtsk->actprc = TPRC_NONE;
(void) make_active(p_runtsk);
}
release_tsk_lock(my_p_pcb);
exit_and_dispatch();
ercd = E_SYS;
}
else {
/* 移動先のプロセッサのPCBを取得 */
t_p_pcb = get_mp_p_pcb(p_runtsk->actprc);
/* 一旦タスクロックを離す */
release_tsk_lock(my_p_pcb);
/*
* 現在割り付けられているプロセッサと移動先のプロセッサのタスク
* ロックを取得
*/
if (locked) {
acquire_dual_tsk_lock_without_preemption(p_runtsk, p_runtsk->actprc, &my_p_pcb, &t_p_pcb);
}
else {
t_acquire_dual_tsk_lock(p_runtsk, p_runtsk->actprc, &my_p_pcb, &t_p_pcb);
}
/*
* マイグレーション先のプロセッサが変更された場合はリトライ
*/
if (p_runtsk->actprc != t_p_pcb->prcid) {
release_dual_tsk_lock(p_runtsk->p_pcb, t_p_pcb);
goto retry;
}
/*
* ここで各カーネル状態を変更するのは，ディスパッチ禁止状態と割込
* み優先度マスク全解除状態でない状態による過度状態の場合に，各カ
* ーネル状態を変更してから，ロック取得関数で割込みを許可して割込
* みが入ると，割込みからのリターン時にディスパッチャが呼ばれてし
* まい，休止状態となるためである．
*/
my_p_pcb->disdsp = false;
t_set_ipm(TIPM_ENAALL);
my_p_pcb->ipmflg = true;
my_p_pcb->dspflg = true;
force_unlock_spin(my_p_pcb);
/* 現在コンテキストを捨ててマイグレーション */
exit_and_migrate(p_runtsk->actprc);
ercd = E_SYS;
}
error_exit:
LOG_EXT_TSK_LEAVE(ercd);
return(ercd);
}
ER
ext_tsk(void)
{
ER ercd;
PCB *my_p_pcb;
TCB *p_runtsk;
LOG_EXT_TSK_ENTER();
CHECK_TSKCTX();
/*
* CPUロック状態でext_tskが呼ばれた場合は，ロック取得時に割込みを許可
* しない.
* ロック取得時に割込みを許可しないのは， 過度状態の場合にロックを取得
* できなかった場合に割込みを許可すると，割込みが入りサスペンド状態と
* なってしまうためである．
* ディスパッチ禁止や割込み優先度マスク全解除状態でない場合の過度状態の
* 場合は，割込みが入っても割込みの出口でディスパッチャに行かずに戻って
* くるため問題ない．
*/
if (t_sense_lock()) {
my_p_pcb = acquire_tsk_lock_without_preemption_self();
}
else {
t_lock_cpu();
my_p_pcb = t_acquire_tsk_lock_self_without_runnable_check();
}
p_runtsk = my_p_pcb->p_runtsk;
if (my_p_pcb->disdsp) {
/*
* ディスパッチ禁止状態でext_tskが呼ばれた場合に対応して，ディスパッ
* チ許可状態にしてからタスクを終了する．
*/
my_p_pcb->disdsp = false;
}
if (!my_p_pcb->ipmflg) {
/*
* 割込み優先度マスク（IPM）がTIPM_ENAALL以外の状態でext_tskが呼ばれ
* た場合に対応して，IPMをTIPM_ENAALLにしてからタスクを終了する．
*/
t_set_ipm(TIPM_ENAALL);
my_p_pcb->ipmflg = true;
}
my_p_pcb->dspflg = true;
/*
* スピンロックを取得している場合は，スピンロックを解除する
*/
force_unlock_spin(my_p_pcb);
/* 再起動時のマイグレーションなし */
if ((p_runtsk->actprc == TPRC_NONE) || (p_runtsk->actprc == my_p_pcb->prcid)) {
(void) make_non_runnable(p_runtsk);
make_dormant(p_runtsk);
if (p_runtsk->actque) {
p_runtsk->actque = false;
p_runtsk->actprc = TPRC_NONE;
(void) make_active(p_runtsk);
}
release_tsk_lock(my_p_pcb);
exit_and_dispatch();
ercd = E_SYS;
}
else {
/* 現在コンテキストを捨ててマイグレーション */
exit_and_migrate(p_runtsk->actprc);
ercd = E_SYS;
}
error_exit:
LOG_EXT_TSK_LEAVE(ercd);
return(ercd);
}