source: anotherchoice/tags/jsp-1.4.4-full-UTF8/config/s1c33/cpu_config.h

/*
 *  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用)
 */


#ifndef _CPU_CONFIG_H_
#define _CPU_CONFIG_H_

/*
 *  カーネルの内
部識別名のリネーム
 */
#include "cpu_rename.h"


/*
 *  設定可能な最高割り込み優å…
ˆåº¦
 */
#define TPS_INTLEV_MAX  (0x04)
#define TPS_CPULOCK_LEV (TPS_INTLEV_MAX + 1)

/*
 *  TCB 中のフィールドのビット幅
の定義
 */
#define TBIT_TCB_PRIORITY       8       /* priority フィールドのビット幅
 */
#define TBIT_TCB_TSTAT          8       /* tstat フィールドのビット幅
  */


#ifndef _MACRO_ONLY
/*
 *  TCB 関連の定義
 *  cpu_context.h にå…
¥ã‚Œã‚‹æ–¹ãŒã‚¨ãƒ¬ã‚¬ãƒ³ãƒˆã が，参ç…
§ã®ä¾å­˜æ€§ã®é–¢ä¿‚で，
 *  cpu_context.h にはå…
¥ã‚Œã‚‰ã‚Œãªã„．
 */
/*
 *  タスクコンテキストブロックの定義
 *  Task context block.
 */
typedef struct task_context_block {
        VP sp;                          /* スタックポインタ     */
        FP pc;                          /* プログラムカウンタ  */
} CTXB;


/*
 *  最高優å…
ˆé †ä½ã‚¿ã‚¹ã‚¯ã¸ã®ãƒ‡ã‚£ã‚¹ãƒ‘ッチ(cpu_config.c)
 *
 *  dispatch は，タスクコンテキストから呼び出されたサービスコール処理
 *  内
で，CPUロック状æ…
‹ã§å‘¼ã³å‡ºã•ãªã‘ればならない．
 */
extern void dispatch(void);

/*
 *  現在のコンテキストを捨ててディスパッチ(cpu_config.c)
 *
 *  exit_and_dispatch は，CPUロック状æ…
‹ã§å‘¼ã³å‡ºã•ãªã‘ればならない．
 */
extern void exit_and_dispatch(void);

/*
 *  プロセッサ依存の初期化
 */
extern void     cpu_initialize(void);

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

/*
 *  CPUロック解除時に復å…
ƒã™ã‚‹å‰²ã‚Šè¾¼ã¿ãƒ¬ãƒ™ãƒ«
 */
extern UINT     tps_OrgIntLevel;

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

/*
 *  ビットサーチマクロ使用の設定
 */
#ifndef __c33pe
#define CPU_BITMAP_SEARCH
#endif  /* __c33pe */

/*
 *  プロセッサの特殊命令のインライン関数定義
 */
#include "cpu_insn.h"

/*
 * システム状æ…
‹å‚ç…
§é–¢æ•°ã®åˆ¥åå®šç¾©
 */
#define t_sense_lock    sense_lock
#define i_sense_lock    sense_lock
#define t_lock_cpu      lock_cpu
#define i_lock_cpu      lock_cpu
#define t_unlock_cpu    unlock_cpu
#define i_unlock_cpu    unlock_cpu

/*
 *  現在のコンテキスト状æ…
‹ã‚’参ç…
§
 */
Inline BOOL
sense_context()
{
        return ((tps_IntNestCnt) ? TRUE : FALSE);
}

/*
 *  現在のCPUロック状æ…
‹ã‚’参ç…
§
 */
Inline BOOL
sense_lock()
{
        UW      ulIntLevel;

        ulIntLevel = get_psr();

        ulIntLevel = (ulIntLevel & S1C33_PSR_MASK_IL);
        return ((ulIntLevel < (TPS_CPULOCK_LEV << 8)) ? FALSE : TRUE);
}

/*
 * CPUロック状æ…
‹è¨­å®šå‡¦ç†
 */
Inline void
lock_cpu()
{
        UW      ulPsr, ulIntLevel;

        ulPsr = get_psr();
        ulIntLevel = (ulPsr & S1C33_PSR_MASK_IL);

        if(ulIntLevel < (TPS_CPULOCK_LEV << 8)){
                ulPsr &= ~S1C33_PSR_MASK_IL;
                set_psr(ulPsr | (TPS_CPULOCK_LEV << 8));
                tps_OrgIntLevel = ulIntLevel;
        }
}

Inline void
unlock_cpu()
{
        UW      ulPsr;

        ulPsr = get_psr();
        ulPsr &= ~S1C33_PSR_MASK_IL;
        ulPsr |= tps_OrgIntLevel;
        tps_OrgIntLevel = (TPS_INIT_INTLEVEL << 8);

        set_psr(ulPsr);
}

/*
 *  CPU例外の発生した時のシステム状æ…
‹ã®å‚ç…
§
 */
/*
 *  CPU例外の発生した時のコンテキストの参ç…
§
 */
Inline BOOL
exc_sense_context(VP p_excinf)
{
        return ((tps_IntNestCnt > 1) ? TRUE : FALSE);
}

/*
 *  CPU例外の発生した時のCPUロック状æ…
‹ã®å‚ç…
§
 */
Inline BOOL
exc_sense_lock(VP p_excinf)
{
        UW      ulPsr;

        ulPsr = ((*((UW *)p_excinf) & S1C33_PSR_MASK_IL) >> 8);
        return (ulPsr == TPS_CPULOCK_LEV) ? TRUE : FALSE;
}

/*
 *  ä¾‹å¤–ãƒ™ã‚¯ã‚¿ãƒ†ãƒ¼ãƒ–ãƒ«ã®æ§‹é€ ã®å®šç¾©
 */
typedef struct exc_vector_entry {
        FP exchdr;                              /* 例外ハンドラの起動番地 */
} EXCVE;

/*
 *  CPU例外ハンドラの設定
 */
#define define_exc      define_inh

/*
 *  割込みハンドラの設定
 */
Inline void
define_inh(INHNO inhno, FP inthdr)
{
        EXCVE   *excvt;

        excvt = (EXCVE *) get_ttbr();
        excvt[inhno].exchdr = inthdr;
}

/*
 *  割込みハンドラの出å…
¥å£å‡¦ç†ã®ç”Ÿæˆãƒžã‚¯ãƒ­
 */
#define INTHDR_ENTRY(inthdr)    void inthdr##_entry(void) { tpsIntPreWrap(); asm("xcall " #inthdr); tpsIntPostWrap(); }
#define INT_ENTRY(inthdr)       inthdr##_entry

/*
 *  CPU例外ハンドラの出å…
¥å£å‡¦ç†ã®ç”Ÿæˆãƒžã‚¯ãƒ­
 */
#define EXCHDR_ENTRY(exchdr)    INTHDR_ENTRY(exchdr)
#define EXC_ENTRY(exchdr)       exchdr##_entry

/*
 *  割込み/CPU例外ハンドラの出å…
¥å£å‡¦ç†
 *
 *  idle中は割り込まれたスタック==stacktopなので、
 *  idleルーチンにもretiで復帰できる位置に割り込みスタックを設定している
 */
Inline void
tpsIntPreWrap(void)
{
#if TPS_DAREA_CNT == 4                  /* データエリア数に応じて退避      */
        Asm("pushn %r11");              /* レジスタ数を変更する。    */
#elif TPS_DAREA_CNT == 3
        Asm("pushn %r12");
#elif TPS_DAREA_CNT == 2
        Asm("pushn %r13");
#elif TPS_DAREA_CNT == 1
        Asm("pushn %r14");
#else
        Asm("pushn %r15");
#endif /* TPS_DAREA */

#ifdef  __c33adv
        Asm("pushs      %sor                            ");
#else   /* __c33adv */
        Asm("ld.w       %r0, %ahr                       ");
        Asm("ld.w       %r1, %alr                       ");
#endif  /* __c33adv */

        Asm("ld.w       %r2, %sp                        ");     /* スタックの切り替え、               */
        Asm("xld.w      %r3, _kernel_tps_IntNestCnt     ");     /* 割り込みカウンタの更新、 */
        Asm("ld.w       %r5, [%r3]                      ");     /* 多重割り込みの許可を行う */
        Asm("xld.w      %%r4, %0 - 8  " : : "g"(STACKTOP));
        Asm("cmp        %r5, 0x00                       ");
        Asm("jrne       0f                              ");
        Asm("ld.w       %sp, %r4                        ");
        Asm("0:                                         ");
        Asm("add        %r5, 1                          ");
        Asm("ld.w       [%r3], %r5                      ");
        Asm("ld.w       %r4, %psr                       ");
        Asm("or         %r4, 0x10                       ");
        Asm("ld.w       %psr, %r4                       ");
        Asm("ld.w       %r6, %r2                        ");

#ifdef  __c33adv                                                /* pushs命令によるスタック使用       */
        Asm("add        %r6, 24");                              /* ã‚µã‚¤ã‚ºã‚’åŠ ç®—ã™ã‚‹             */
#endif  /* __c33adv */
        
#if TPS_DAREA_CNT == 4
        Asm("add        %r6, 48");
#elif TPS_DAREA_CNT == 3
        Asm("add        %r6, 52");
#elif TPS_DAREA_CNT == 2
        Asm("add        %r6, 56");
#elif TPS_DAREA_CNT == 1
        Asm("add        %r6, 60");
#else
        Asm("ext        0x0001");
        Asm("add        %r6, 0x00");
#endif /* TPS_DAREA */
}

Inline void
tpsIntPostWrap(void)
{
        Asm("ld.w       %r4, %psr               ");     /* 割り込みをディセーブルする      */
        Asm("xand       %r4, 0xfffff0ff         ");
        Asm("xld.w      %%r5, %0"
                : : "g"(TPS_CPULOCK_LEV << 8));
        Asm("or         %r4, %r5                ");
        Asm("ld.w       %psr, %r4               ");

        Asm("ld.w       %r4, [%r3]              ");     /* tps_IntNestCntを更新する        */
        Asm("sub        %r4, 1                  ");
        Asm("ld.w       [%r3], %r4              ");

        Asm("ld.w       %sp, %r2                ");     /* ã‚¹ã‚¿ãƒƒã‚¯é ˜åŸŸã‚’å¾©å…
ƒã™ã‚‹    */

        Asm("cmp        %r4, 0x00               ");
        Asm("xjrne      0f                      ");
        Asm("xld.w      %r3, _kernel_reqflg     ");
        Asm("ld.w       %r3, [%r3]              ");
        Asm("cmp        %r3, 1                  ");     /* tps_IntNestCnt== 0でディス         */
        Asm("xjreq      _kernel_ret_int         ");     /* パッチが発生していればジャンプ */
        Asm("0:                                 ");     /* する                                 */

#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");
#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");
}

#endif /* _MACRO_ONLY */
#endif /* _CPU_CONFIG_H_ */