source: anotherchoice/tags/jsp-1.4.4-full-UTF8/config/s1c33/cpu_config.c@ 363

/*
 *  TOPPERS/JSP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Just Standard Profile Kernel
 *
 *  Copyright (C) 2000 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 *
 *  Copyright (C) 2004 by SEIKO EPSON Corp, JAPAN
 *
 *  上記著作権者
は，以下の (1)〜(4) の条件か，Free Software Foundation
 *  によってå…
¬è¡¨ã•ã‚Œã¦ã„ã‚‹ GNU General Public License の Version 2 に記
 *  è¿°ã•ã‚Œã¦ã„ã‚‹æ¡ä»¶ã‚’æº€ãŸã™å ´åˆã«é™ã‚Šï¼Œæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ï¼ˆæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢
 *  を改変したものを含む．以下同じ）を使用・複製・改変・再é…
å¸ƒï¼ˆä»¥ä¸‹ï¼Œ
 *  利用と呼ぶ）することを無償で許諾する．
 *  (1) æœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ã‚’ã‚½ãƒ¼ã‚¹ã‚³ãƒ¼ãƒ‰ã®å½¢ã§åˆ©ç”¨ã™ã‚‹å ´åˆã«ã¯ï¼Œä¸Šè¨˜ã®è‘—ä½œ
 *      権表示，この利用条件および下記の無保証規定が，そのままの形でソー
 *      スコード中に含まれていること．
 *  (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
 *      用できる形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
 *      者
マニュアルなど）に，上記の著作権表示，この利用条件および下記
 *      の無保証規定を掲載すること．
 *  (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
 *      用できない形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
 *      と．
 *    (a) 再é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
マニュアルなど）に，上記の著
 *        作権表示，この利用条件および下記の無保証規定を掲載すること．
 *    (b) 再é…
å¸ƒã®å½¢æ…
‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
 *        å ±å‘Šã™ã‚‹ã“ã¨ï¼Ž
 *  (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
 *      害からも，上記著作権者
およびTOPPERSプロジェクトをå…
è²¬ã™ã‚‹ã“と．
 *
 *  本ソフトウェアは，無保証で提供されているものである．上記著作権者
お
 *  よびTOPPERSプロジェクトは，本ソフトウェアに関して，その適用可能性も
 *  含めて，いかなる保証も行わない．また，本ソフトウェアの利用により直
 *  æŽ¥çš„ã¾ãŸã¯é–“æŽ¥çš„ã«ç”Ÿã˜ãŸã„ã‹ãªã‚‹æå®³ã«é–¢ã—ã¦ã‚‚ï¼Œãã®è²¬ä»»ã‚’è² ã‚ãªã„ï¼Ž
 *
 */


/*
 *      プロセッサ依存モジュール(S1C33用)
 */

#include "jsp_kernel.h"
#include "check.h"
#include "task.h"
#include "itron.h"
#include "s1c33.h"
#include "sys_config.h"

/*
 *  CPUロック解除時に復å…
ƒã™ã‚‹
 */
UINT    tps_OrgIntLevel;

/*
 *  割込みネストカウンタ
 */
UINT    tps_IntNestCnt;

/*
 *  割込み制御レジスタ 位置特定処理
 */
ER      get_Offset(INTNO);
ER      get_BitFlag(INTNO);

/*
 *  プロセッサ依存の初期化
 */
void
cpu_initialize()
{
        tps_IntNestCnt = 0;                     /* 割込みネストカウントの初期化 */
        tps_OrgIntLevel = TPS_INIT_INTLEVEL;

        /*
         *  割り込み許可フラグを設定し、OS管理下の割り込みをマスクする
         */
        set_psr((TPS_CPULOCK_LEV << 8) | S1C33_PSR_FLAG_IE);

}

/*
 *  プロセッサ依存の終了処理
 */
void
cpu_terminate()
{

}

/*
 *  タスク起動処理
 */
void
activate_r(void)
{
        unlock_cpu();
        Asm("xld.w %r0, ext_tsk");              /* 戻り位置をext_tskに設定 */
        Asm("pushn %r0");
        Asm("ld.w %%r6, %0": : "r"(runtsk->tinib->exinf));
        set_pc(runtsk->tinib->task);
}

/*
 *  タスクディスパッチャ
 *
 *  dispatchはタスクコンテキスト・CPUロック状æ…
‹ã§å‘¼ã³å‡ºã™ã€‚
 *  exit_and_dispatchも同様だが、カーネル起動時に対応するため
 *  非タスクコンテキスト・CPUロック解除状æ…
‹ã®å‘¼ã³å‡ºã—にも対応
 *  している。
 */
void
dispatch(void)
{
        TCB * task;

        Asm("pushn %r3");
        task = runtsk;
        task->tskctxb.sp = get_sp();
        task->tskctxb.pc = && dispatch_1;       /* gcc拡張機能を使用する */
        Asm("xjp _kernel_exit_and_dispatch");
dispatch_1:
        Asm("popn %r3");
        task = (TCB * volatile) runtsk;
        if ((task->enatex != FALSE) && (task->texptn != 0)) {
                Asm("xjp _kernel_calltex");     /* 例外ハンドラ起動     */
        }
}

void
exit_and_dispatch(void)
{
        register UW     ulPsr;

        lock_cpu();                     /* CPUをロックする        */
        runtsk = schedtsk;
        if (runtsk != NULL) {
                set_sp(runtsk->tskctxb.sp);
                set_pc(runtsk->tskctxb.pc);
        }

        set_sp(STACKTOP);                       /* å®Ÿè¡Œå¯èƒ½ãªã‚¿ã‚¹ã‚¯ãŒãªã„å ´åˆ      */
        ulPsr = get_psr();                      /* 割り込みを許可してイベント      */
        ulPsr |= S1C33_PSR_FLAG_IE;     /* 発生を待
つ                                      */
        set_psr(ulPsr);
        unlock_cpu();

        while (1) {
                Asm("halt");
        }
}

/*
 *  割込みハンドラ/CPU例外ハンドラ出口処理
 */
void
ret_int(void)
{
        static  TCB * task;

        reqflg = FALSE;
        task = runtsk;

        if (task == NULL) {                     /* アイドル処理へジャンプする */
                Asm("xjp _kernel_exit_and_dispatch");
        }

        if ((enadsp != FALSE) && (task != schedtsk)) {
#ifndef __c33adv
                Asm("pushn %r1");
#endif  /* __c33adv */
                task->tskctxb.sp = get_sp();
                task->tskctxb.pc = && ret_int_2;/* gcc拡張機能を使用 */
                                                /* ディスパッチ処理へジャンプ */
                Asm("xjp _kernel_exit_and_dispatch");
ret_int_2:
#ifndef __c33adv
                Asm("popn %r1");
#endif  /* __c33adv */
        }
        task = (TCB * volatile) runtsk;
        if ((task->enatex != FALSE) && (task->texptn != 0)) {
                call_texrtn();                  /* 例外ハンドラ起動     */
        }
#ifdef  __c33adv
        Asm("pops %sor");
#else   /* __c33adv */
        Asm("ld.w %alr, %r1");
        Asm("ld.w %ahr, %r0");
#endif  /* __c33adv */

#if TPS_DAREA_CNT == 4                          /* データエリアポインタ数に */
        Asm("popn %r11");                       /* 応じたpop処理を行う          */
#elif TPS_DAREA_CNT == 3
        Asm("popn %r12");
#elif TPS_DAREA_CNT == 2
        Asm("popn %r13");
#elif TPS_DAREA_CNT == 1
        Asm("popn %r14");
#else
        Asm("popn %r15");
#endif /* TPS_DAREA */

        Asm("reti");                            /* CPUロック状æ…
‹ã¯å¾©å¸°ã—た    */
                                                /* タスクのサービスコールから      */
                                                /* リターンする時に解除される      */
}


/*
 *  割込みレベル変更処理
 */
ER
chg_ilv(ILEVNO ilevno)
{
        UW      ulPsr;
        ER      ercd;

        LOG_CHG_ILV_ENTER(ilevno)
        CHECK_TSKCTX_UNL();
        if(ilevno > TPS_INTLEV_MAX){
                ercd = E_PAR;
        } else {
                ulPsr = get_psr();                      /* 現在のPSR値を取得     */
                ulPsr = (ulPsr & ~S1C33_PSR_MASK_IL) | (ilevno << 8);
                set_psr(ulPsr);                         /* PSR値を更新              */
                ercd = E_OK;
        }
exit:
        LOG_CHG_ILV_LEAVE(ercd)                         /* Set New IL           */
        return(ercd);
}

/*
 *  割込みレベル取得処理
 */
ER
get_ilv(ILEVNO *p_ilevno)
{
        UW      ulPsr;
        ER      ercd;

        LOG_GET_ILV_ENTER(p_ilevno)
        CHECK_TSKCTX_UNL();
        if(p_ilevno == NULL){
                ercd = E_PAR;
        } else {
                ulPsr = get_psr();                      /* 現在の割込みレベルを取得 */
                *p_ilevno = (ulPsr & S1C33_PSR_MASK_IL) >> 8;
                ercd = E_OK;
        }
exit:
        LOG_GET_ILV_LEAVE(ercd, piLevno)
        return(ercd);
}

#ifndef __c33pe
/*
 *  割込み発生許可処理
 */
ER
ena_int(INTNO intno)
{
        INT     iOffset, iBitFlag;

        iOffset = get_Offset(intno);                    /* レジスタ位置を取得する */
        iBitFlag = get_BitFlag(intno);

        if(iOffset == E_PAR || iBitFlag == E_PAR){
                return (E_PAR);
        }
                                                        /* 割り込みを許可する */
        (*(s1c33Intc_t *) S1C33_INTC_BASE).bIntEnable[iOffset] |= (UB)iBitFlag;

        return (E_OK);
}

/*
 *  割込み発生禁止処理
 */
ER
dis_int(INTNO intno)
{
        INT     iOffset, iBitFlag;

        iOffset = get_Offset(intno);                    /* レジスタ位置を取得する  */
        iBitFlag = get_BitFlag(intno);

        if(iOffset == E_PAR || iBitFlag == E_PAR){
                return (E_PAR);
        }
                                                        /* 割り込みを禁止する */
        (*(s1c33Intc_t *) S1C33_INTC_BASE).bIntEnable[iOffset] &= ~((UB)iBitFlag);

        return (E_OK);
}

/*
 *  å‰²è¾¼ã¿ç™ºç”Ÿè¦å› ã‚¯ãƒªã‚¢
 */
ER
clr_int(INTNO intno)
{
        INT     iOffset, iBitFlag;

        iOffset = get_Offset(intno);                    /* レジスタ位置を取得する */
        iBitFlag = get_BitFlag(intno);

        if(iOffset == E_PAR || iBitFlag == E_PAR){
                return (E_PAR);
        }
#ifdef  __c33adv
        if(intno > S1C33_INHNO_SERIAL3TX){              /* 許可/ç¦æ­¢ãƒ¬ã‚¸ã‚¹ã‚¿ã¨è¦å›     */
                iOffset -= 0x0d;                        /* フラグレジスタのオフセット */
        }                                               /* 位置が一致しないため       */
#endif /* __c33adv */
                                                        /* å‰²ã‚Šè¾¼ã¿è¦å› ã‚’ã‚¯ãƒªã‚¢ã™ã‚‹ */
        (*(s1c33Intc_t *) S1C33_INTC_BASE).bIntFactor[iOffset] = ((UB)iBitFlag);

        return (E_OK);
}
#else  /* __c33pe */
#error "*_int() are valid for C33 Standard/Advanced macro."
#endif /* __c33pe */