source: mypx/extension/dcre/kernel/task_except.c @ 7

/*
 *  TOPPERS/ASP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Advanced Standard Profile Kernel
 * 
 *  Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 *  Copyright (C) 2005-2014 by Embedded and Real-Time Systems Laboratory
 *              Graduate School of Information Science, Nagoya Univ., JAPAN
 * 
 *  Ÿåµ­Ãøºîž¢ŒÔ€Ï¡€°Ê²Œ€Î(1)¡Á(4)€ÎŸò·ï€òËþ€¿€¹Ÿì¹ç€ËžÂ€ê¡€ËÜ¥œ¥Õ¥È¥Š¥§
 *  ¥¢¡ÊËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò²þÊÑ€·€¿€â€Î€òŽÞ€à¡¥°Ê²ŒÆ±€ž¡Ë€ò»ÈÍÑ¡ŠÊ£Àœ¡Š²þ
 *  ÊÑ¡ŠºÆÇÛÉۡʰʲŒ¡€ÍøÍрȞƀ֡ˀ¹€ë€³€È€ò̵œþ€ÇµöÂú€¹€ë¡¥
 *  (1) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¥œ¡Œ¥¹¥³¡Œ¥É€Î·Á€ÇÍøÍÑ€¹€ëŸì¹ç€Ë€Ï¡€Ÿåµ­€ÎÃøºî
 *      ž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­€Î̵ÊÝŸÚµ¬Äꀬ¡€€œ€Î€Þ€Þ€Î·Á€Ç¥œ¡Œ
 *      ¥¹¥³¡Œ¥ÉÃæ€ËŽÞ€Þ€ì€Æ€€€ë€³€È¡¥
 *  (2) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¡€¥é¥€¥Ö¥é¥ê·ÁŒ°€Ê€É¡€ÂŸ€Î¥œ¥Õ¥È¥Š¥§¥¢³«È¯€Ë»È
 *      Íрǀ­€ë·Á€ÇºÆÇÛÉÛ€¹€ëŸì¹ç€Ë€Ï¡€ºÆÇÛÉÛ€ËÈŒ€Š¥É¥­¥å¥á¥ó¥È¡ÊÍøÍÑ
 *      ŒÔ¥Þ¥Ë¥å¥¢¥ë€Ê€É¡Ë€Ë¡€Ÿåµ­€ÎÃøºîž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­
 *      €Î̵ÊÝŸÚµ¬Äê€ò·ÇºÜ€¹€ë€³€È¡¥
 *  (3) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¡€µ¡Žï€ËÁȀ߹þ€à€Ê€É¡€ÂŸ€Î¥œ¥Õ¥È¥Š¥§¥¢³«È¯€Ë»È
 *      Íрǀ­€Ê€€·Á€ÇºÆÇÛÉÛ€¹€ëŸì¹ç€Ë€Ï¡€Œ¡€Î€€€º€ì€«€ÎŸò·ï€òËþ€¿€¹€³
 *      €È¡¥
 *    (a) ºÆÇÛÉÛ€ËÈŒ€Š¥É¥­¥å¥á¥ó¥È¡ÊÍøÍьԥޥ˥奢¥ë€Ê€É¡Ë€Ë¡€Ÿåµ­€ÎÃø
 *        ºîž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­€Î̵ÊÝŸÚµ¬Äê€ò·ÇºÜ€¹€ë€³€È¡¥
 *    (b) ºÆÇÛÉۀηÁÂÖ€ò¡€ÊÌ€ËÄê€á€ëÊýË¡€Ë€è€Ã€Æ¡€TOPPERS¥×¥í¥ž¥§¥¯¥È€Ë
 *        Êó¹ð€¹€ë€³€È¡¥
 *  (4) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ÎÍøÍрˀè€êÄŸÀÜŪ€Þ€¿€ÏŽÖÀÜŪ€ËÀž€ž€ë€€€«€Ê€ë»
 *      ³²€«€é€â¡€Ÿåµ­Ãøºîž¢ŒÔ€ª€è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€òÌÈÀÕ€¹€ë€³€È¡¥
 *      €Þ€¿¡€ËÜ¥œ¥Õ¥È¥Š¥§¥¢€Î¥æ¡Œ¥¶€Þ€¿€Ï¥š¥ó¥É¥æ¡Œ¥¶€«€é€Î€€€«€Ê€ëÍý
 *      ͳ€ËŽð€Å€¯ÀÁµá€«€é€â¡€Ÿåµ­Ãøºîž¢ŒÔ€ª€è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€ò
 *      ÌÈÀÕ€¹€ë€³€È¡¥
 * 
 *  ËÜ¥œ¥Õ¥È¥Š¥§¥¢€Ï¡€ÌµÊÝŸÚ€ÇÄ󶡀µ€ì€Æ€€€ë€â€Î€Ç€¢€ë¡¥Ÿåµ­Ãøºîž¢ŒÔ€ª
 *  €è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€Ï¡€ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ËŽØ€·€Æ¡€ÆÃÄê€Î»ÈÍÑÌÜŪ
 *  €ËÂЀ¹€ëŬ¹çÀ­€âŽÞ€á€Æ¡€€€€«€Ê€ëÊÝŸÚ€â¹Ô€ï€Ê€€¡¥€Þ€¿¡€ËÜ¥œ¥Õ¥È¥Š¥§
 *  ¥¢€ÎÍøÍрˀè€êÄŸÀÜŪ€Þ€¿€ÏŽÖÀÜŪ€ËÀž€ž€¿€€€«€Ê€ë»³²€ËŽØ€·€Æ€â¡€€œ
 *  €ÎÀÕÇ€€òÉé€ï€Ê€€¡¥
 * 
 *  $Id$
 */

/*
 *              ¥¿¥¹¥¯Îã³°œèÍýµ¡Çœ
 */

#include "kernel_impl.h"
#include "check.h"
#include "task.h"

/*
 *  ¥È¥ì¡Œ¥¹¥í¥°¥Þ¥¯¥í€Î¥Ç¥Õ¥©¥ë¥ÈÄêµÁ
 */
#ifndef LOG_DEF_TEX_ENTER
#define LOG_DEF_TEX_ENTER(tskid, pk_dtex)
#endif /* LOG_DEF_TEX_ENTER */

#ifndef LOG_DEF_TEX_LEAVE
#define LOG_DEF_TEX_LEAVE(ercd)
#endif /* LOG_DEF_TEX_LEAVE */

#ifndef LOG_RAS_TEX_ENTER
#define LOG_RAS_TEX_ENTER(tskid, rasptn)
#endif /* LOG_RAS_TEX_ENTER */

#ifndef LOG_RAS_TEX_LEAVE
#define LOG_RAS_TEX_LEAVE(ercd)
#endif /* LOG_RAS_TEX_LEAVE */

#ifndef LOG_IRAS_TEX_ENTER
#define LOG_IRAS_TEX_ENTER(tskid, rasptn)
#endif /* LOG_IRAS_TEX_ENTER */

#ifndef LOG_IRAS_TEX_LEAVE
#define LOG_IRAS_TEX_LEAVE(ercd)
#endif /* LOG_IRAS_TEX_LEAVE */

#ifndef LOG_DIS_TEX_ENTER
#define LOG_DIS_TEX_ENTER()
#endif /* LOG_DIS_TEX_ENTER */

#ifndef LOG_DIS_TEX_LEAVE
#define LOG_DIS_TEX_LEAVE(ercd)
#endif /* LOG_DIS_TEX_LEAVE */

#ifndef LOG_ENA_TEX_ENTER
#define LOG_ENA_TEX_ENTER()
#endif /* LOG_ENA_TEX_ENTER */

#ifndef LOG_ENA_TEX_LEAVE
#define LOG_ENA_TEX_LEAVE(ercd)
#endif /* LOG_ENA_TEX_LEAVE */

#ifndef LOG_SNS_TEX_ENTER
#define LOG_SNS_TEX_ENTER()
#endif /* LOG_SNS_TEX_ENTER */

#ifndef LOG_SNS_TEX_LEAVE
#define LOG_SNS_TEX_LEAVE(state)
#endif /* LOG_SNS_TEX_LEAVE */

#ifndef LOG_REF_TEX_ENTER
#define LOG_REF_TEX_ENTER(tskid, pk_rtex)
#endif /* LOG_REF_TEX_ENTER */

#ifndef LOG_REF_TEX_LEAVE
#define LOG_REF_TEX_LEAVE(ercd, pk_rtex)
#endif /* LOG_REF_TEX_LEAVE */

/*
 *  ¥¿¥¹¥¯Îã³°œèÍý¥ë¡Œ¥Á¥ó€ÎÄêµÁ
 */
#ifdef TOPPERS_def_tex

ER_UINT
def_tex(ID tskid, const T_DTEX *pk_dtex)
{
        TCB             *p_tcb;
        TINIB   *p_tinib;
        ER              ercd;

        LOG_DEF_TEX_ENTER(tskid, pk_dtex);
        CHECK_TSKCTX_UNL();
        CHECK_TSKID_SELF(tskid);
        CHECK_RSATR(pk_dtex->texatr, TA_NULL);
        if (pk_dtex->texrtn != NULL) {
                CHECK_ALIGN_FUNC(pk_dtex->texrtn);
                CHECK_NONNULL_FUNC(pk_dtex->texrtn);
        }
        p_tcb = get_tcb_self(tskid);
        p_tinib = (TINIB *)(p_tcb->p_tinib);

        t_lock_cpu();
        if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (TSKID(p_tcb) > tmax_stskid) {
                if (pk_dtex->texrtn != NULL) {
                        if (p_tinib->texrtn != NULL) {
                                ercd = E_OBJ;
                        }
                        else {
                                p_tinib->texatr = pk_dtex->texatr;
                                p_tinib->texrtn = pk_dtex->texrtn;
                                ercd = E_OK;
                        }
                }
                else {
                        if (p_tinib->texrtn != NULL) {
                                p_tinib->texrtn = NULL;
                                p_tcb->enatex = false;
                                p_tcb->texptn = 0U;
                                ercd = E_OK;
                        }
                        else {
                                ercd = E_OBJ;
                        }
                }
        }
        else {
                ercd = E_OBJ;
        }
        t_unlock_cpu();

  error_exit:
        LOG_DEF_TEX_LEAVE(ercd);
        return(ercd);
}

#endif /* TOPPERS_def_tex */

/*
 *  ¥¿¥¹¥¯Îã³°œèÍý€ÎÍ×µá
 */
#ifdef TOPPERS_ras_tex

ER
ras_tex(ID tskid, TEXPTN rasptn)
{
        TCB             *p_tcb;
        ER              ercd;

        LOG_RAS_TEX_ENTER(tskid, rasptn);
        CHECK_TSKCTX_UNL();
        CHECK_TSKID_SELF(tskid);
        CHECK_PAR(rasptn != 0U);
        p_tcb = get_tcb_self(tskid);

        t_lock_cpu();
        if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
                ercd = E_OBJ;
        }
        else {
                p_tcb->texptn |= rasptn;
                if (p_tcb == p_runtsk && p_runtsk->enatex && ipmflg) {
                        call_texrtn();
                }
                ercd = E_OK;
        }
        t_unlock_cpu();

  error_exit:
        LOG_RAS_TEX_LEAVE(ercd);
        return(ercd);
}

#endif /* TOPPERS_ras_tex */

/*
 *  ¥¿¥¹¥¯Îã³°œèÍý€ÎÍ×µá¡ÊÈ󥿥¹¥¯¥³¥ó¥Æ¥­¥¹¥ÈÍÑ¡Ë
 */
#ifdef TOPPERS_iras_tex

ER
iras_tex(ID tskid, TEXPTN rasptn)
{
        TCB             *p_tcb;
        ER              ercd;

        LOG_IRAS_TEX_ENTER(tskid, rasptn);
        CHECK_INTCTX_UNL();
        CHECK_TSKID(tskid);
        CHECK_PAR(rasptn != 0U);
        p_tcb = get_tcb(tskid);

        i_lock_cpu();
        if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
                ercd = E_OBJ;
        }
        else {
                p_tcb->texptn |= rasptn;
                if (p_tcb == p_runtsk && p_runtsk->enatex && ipmflg) {
                        reqflg = true;
                }
                ercd = E_OK;
        }
        i_unlock_cpu();

  error_exit:
        LOG_IRAS_TEX_LEAVE(ercd);
        return(ercd);
}

#endif /* TOPPERS_iras_tex */

/*
 *  ¥¿¥¹¥¯Îã³°œèÍý€Î¶Ø»ß
 */
#ifdef TOPPERS_dis_tex

ER
dis_tex(void)
{
        ER              ercd;

        LOG_DIS_TEX_ENTER();
        CHECK_TSKCTX_UNL();

        t_lock_cpu();
        if (p_runtsk->p_tinib->texrtn == NULL) {
                ercd = E_OBJ;
        }
        else {
                p_runtsk->enatex = false;
                ercd = E_OK;
        }
        t_unlock_cpu();

  error_exit:
        LOG_DIS_TEX_LEAVE(ercd);
        return(ercd);
}

#endif /* TOPPERS_dis_tex */

/*
 *  ¥¿¥¹¥¯Îã³°œèÍý€Îµö²Ä
 */
#ifdef TOPPERS_ena_tex

ER
ena_tex(void)
{
        ER              ercd;

        LOG_ENA_TEX_ENTER();
        CHECK_TSKCTX_UNL();

        t_lock_cpu();
        if (p_runtsk->p_tinib->texrtn == NULL) {
                ercd = E_OBJ;
        }
        else {
                p_runtsk->enatex = true;
                if (p_runtsk->texptn != 0U && ipmflg) {
                        call_texrtn();
                }
                ercd = E_OK;
        }
        t_unlock_cpu();

  error_exit:
        LOG_ENA_TEX_LEAVE(ercd);
        return(ercd);
}

#endif /* TOPPERS_ena_tex */

/*
 *  ¥¿¥¹¥¯Îã³°œèÍý¶Ø»ßŸõÂրλ²ŸÈ
 */
#ifdef TOPPERS_sns_tex

bool_t
sns_tex(void)
{
        bool_t  state;

        LOG_SNS_TEX_ENTER();
        state = (p_runtsk != NULL && p_runtsk->enatex) ? false : true;
        LOG_SNS_TEX_LEAVE(state);
        return(state);
}

#endif /* TOPPERS_sns_tex */

/*
 *  ¥¿¥¹¥¯Îã³°œèÍý€ÎŸõÂÖ»²ŸÈ
 */
#ifdef TOPPERS_ref_tex

ER
ref_tex(ID tskid, T_RTEX *pk_rtex)
{
        TCB             *p_tcb;
        ER              ercd;

        LOG_REF_TEX_ENTER(tskid, pk_rtex);
        CHECK_TSKCTX_UNL();
        CHECK_TSKID_SELF(tskid);
        p_tcb = get_tcb_self(tskid);

        t_lock_cpu();
        if (p_tcb->p_tinib->tskatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (TSTAT_DORMANT(p_tcb->tstat) || p_tcb->p_tinib->texrtn == NULL) {
                ercd = E_OBJ;
        }
        else {
                pk_rtex->texstat = (p_tcb->enatex) ? TTEX_ENA : TTEX_DIS;
                pk_rtex->pndptn = p_tcb->texptn;
                ercd = E_OK;
        }
        t_unlock_cpu();

  error_exit:
        LOG_REF_TEX_LEAVE(ercd, pk_rtex);
        return(ercd);
}

#endif /* TOPPERS_ref_tex */