cpu_config.c

嵌入式系统开发 TOPPERS and JSP Kernel Release 1.3 TOPPERS = Toyohashi Open Platform for Embedded Real-Tim

/*
 *  TOPPERS/JSP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Just Standard Profile Kernel
 * 
 *  Copyright (C) 2000,2001 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 * 
 *  惧淡螟侯涪荚は·Free Software Foundation によって给山されている 
 *  GNU General Public License の Version 2 に淡揭されている掘凤か·笆
 *  布の(1)×(4)の掘凤を塔たす眷圭に嘎り·塑ソフトウェア∈塑ソフトウェ
 *  アを猖恃したものを崔むˉ笆布票じ∷を蝗脱ˇ剩澜ˇ猖恃ˇ浩芹邵∈笆布·
 *  网脱と钙ぶ∷することを痰浸で钓满するˉ
 *  (1) 塑ソフトウェアをソ〖スコ〖ドの妨で网脱する眷圭には·惧淡の螟侯
 *      涪山绩·この网脱掘凤および布淡の痰瘦沮惮年が·そのままの妨でソ〖
 *      スコ〖ド面に崔まれていることˉ
 *  (2) 塑ソフトウェアを浩网脱材墙なバイナリコ〖ド∈リロケ〖タブルオブ
 *      ジェクトファイルやライブラリなど∷の妨で网脱する眷圭には·网脱
 *      に燃うドキュメント∈网脱荚マニュアルなど∷に·惧淡の螟侯涪山绩·
 *      この网脱掘凤および布淡の痰瘦沮惮年を非很することˉ
 *  (3) 塑ソフトウェアを浩网脱稍材墙なバイナリコ〖ドの妨または怠达に寥
 *      み哈んだ妨で网脱する眷圭には·肌のいずれかの掘凤を塔たすことˉ
 *    (a) 网脱に燃うドキュメント∈网脱荚マニュアルなど∷に·惧淡の螟侯
 *        涪山绩·この网脱掘凤および布淡の痰瘦沮惮年を非很することˉ
 *    (b) 网脱の妨轮を·侍に年める数恕によって·惧淡螟侯涪荚に鼠桂する
 *        ことˉ
 *  (4) 塑ソフトウェアの网脱により木儡弄または粗儡弄に栏じるいかなる禄
 *      巢からも·惧淡螟侯涪荚を倘勒することˉ
 * 
 *  塑ソフトウェアは·痰瘦沮で捏丁されているものであるˉ惧淡螟侯涪荚は·
 *  塑ソフトウェアに簇して·その努脱材墙拉も崔めて·いかなる瘦沮も乖わ
 *  ないˉまた·塑ソフトウェアの网脱により木儡弄または粗儡弄に栏じたい
 *  かなる禄巢に簇しても·その勒扦を砷わないˉ
 * 
 *  @(#) $Id: cpu_config.c,v 1.15 2002/04/05 07:43:51 honda Exp $
 */


#include "jsp_kernel.h"
#include "check.h"
#include "task.h"
#include "sys_defs.h"

#if defined(SH7750)
#include "sh4.h"
#else   
#include "sh3.h"
#endif /* SH7750 */
/*
 *  プロセッサ巴赂モジュ〖ル∈SH3脱∷
 */

/*
 *  タスクコンテキストでの充哈みマスク
 */
#ifdef SUPPORT_CHG_IPM
UW	task_intmask;
#endif /* SUPPORT_CHG_IPM */

/*
 *  润タスクコンテキストでの充哈みマスク
 */
UW	int_intmask;


/*
 * 充り哈みハンドラ/庭黎刨の悼击テ〖ブル
 */
FP  int_table[0x50];
VW  int_plevel_table[0x50];

/*
 * CPU毋嘲ハンドラの悼击テ〖ブル
 */
FP	exc_table[(0x1E0 >> 5) + 1];

/*
 *  プロセッサ巴赂の介袋步
 */
void
cpu_initialize()
{
    int i;
    
    /*
     *  タスクコンテキストでの充哈みマスクの介袋步
     */
#ifdef SUPPORT_CHG_IPM
    task_intmask = 0x0000;    
#endif /* SUPPORT_CHG_IPM */
    
    /*
     * int_table[],int_plevel_table[]の介袋步
     * 踏判峡の充哈み券栏箕にcpu_interrup()が钙び叫されるように
     * no_reg_interrup()を判峡する
     */
    for(i = 0; i < 0x50; i++){
        int_table[i] = no_reg_interrupt;
        int_plevel_table[i] = 0x400000f0;
    }
    
#ifndef GDB_STUB
    /*
     * 充り哈みコントロ〖ラの介袋步 
     */
#if defined(SH7750)
    *ICR  = 0x0000;
    *IPRA = 0x0000;
    *IPRB = 0x0000;
    *IPRC = 0x0000;
#else /* SH7708 || SH7709 || SH7709A */   
    *ICR0 = 0x0000;
    *IPRA = 0x0000;     
    *IPRB = 0x0000;
#if defined(SH7709) || defined(SH7709A)    
    *ICR1 = 0x4000;
    *ICR2 = 0x0000;     
    *PINTER = 0x0000;
    *IPRC = 0x0000;
    *IPRD = 0x0000;
    *IPRE = 0x0000;
    *IRR0 = 0x0000;   
    *IRR1 = 0x0000;
    *IRR2 = 0x0000;
#endif /* SH7709 || SH7709A  */   
#endif /* SH7750 */
    
    /*
     *  ベクタベ〖スレジスタ〖の介袋步
     */
    set_vbr(BASE_VBR);
    
#endif /* GDB_STUB */

    
}



/*
 *  プロセッサ巴赂の姜位借妄
 */
void
cpu_terminate()
{
}


/*
 * Trapa笆嘲の毋嘲で判峡されていない毋嘲が券栏すると钙び叫される
 */
void
cpu_expevt(VW expevt,VW spc,VW ssr,VW pr)
{
    syslog(LOG_EMERG, "Unregistered Expevt error occurs.");
    syslog(LOG_EMERG, "Expevt = %08x SPC = %08x SR = %08x PR=%08X",
           expevt,spc,ssr,pr);
    while(1);
}

/*
 * 踏判峡の充哈みが券栏した眷圭に钙び叫される
 */
void
cpu_interrupt(VW intevt, VW intevt2,VW spc,VW ssr)
{
    syslog(LOG_EMERG, "Unregistered Interrupt occurs.");
#if defined(SH7709) || defined(SH7709A)
    syslog(LOG_EMERG, "INTEVT = %08x INTEVT2 = %08x SPC = %08x SR = %08x ",
           intevt,intevt2,spc,ssr);
#else    
    syslog(LOG_EMERG, "INTEVT = %08x  SPC = %08x SR = %08x ",intevt,spc,ssr);
#endif    
    while(1);
}



#ifdef SUPPORT_CHG_IPM

/*
 *  充哈みマスクの恃构
 *
 *  chg_ipm を蝗って IPM を MAX_IPM ∈NMI スタブリモ〖トブレ〖ク 笆嘲
 *  のすべての充哈みを敦贿∷笆惧に恃构することはできないˉNMI スタブリ
 *  モ〖トブレ〖ク笆嘲のすべての充哈みを敦贿したい眷圭には、loc_cpu に
 *  よりCPUロック觉轮にすればよいˉIPM が 0 笆嘲の箕にも·タスクディス
 *  パッチは瘦伪されないˉIPM は·タスクディスパッチによって·糠しく悸
 *  乖觉轮になったタスクへ苞き费がれるˉそのため·タスクが悸乖面に·侍
 *  のタスクによって IPM が恃构される眷圭があるˉJSPカ〖ネルでは·IPM
 *  の恃构はタスク毋嘲借妄ル〖チンによっても弹こるので·これによって胺
 *  いが岂しくなる觉斗は警ないと蛔われるˉIPM の猛によってタスクディス
 *  パッチを敦贿したい眷圭には·dis_dsp を驶脱すればよいˉ
 */

SYSCALL ER
chg_ipm(IPM ipm)
{
	CHECK_TSKCTX_UNL();
	CHECK_PAR(0 <= ipm && ipm <= MAX_IPM - 1);

	t_lock_cpu();
	task_intmask = (ipm << 4);
	t_unlock_cpu();
	return(E_OK);
}

/*
 *  充哈みマスクの徊救
 */
SYSCALL ER
get_ipm(IPM *p_ipm)
{
	CHECK_TSKCTX_UNL();

	t_lock_cpu();
	*p_ipm = (task_intmask >> 4);
	t_unlock_cpu();
	return(E_OK);
}


            



#endif /* SUPPORT_CHG_IPM */