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


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

#include "sh1.h"

/*
 *  プロセッサ巴赂モジュ〖ル∈SH1脱∷
 */

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

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

/*
 *  充哈み】CPU毋嘲ネストカウンタ
 */
UW	intnest;


/*
 *  毋嘲ベクタテ〖ブル
 */
#ifdef EXCVT_KERNEL
EXCVE BASE_VBR[EXCVT_SIZE];
#endif	/*  EXCVT_KERNEL  */


/*
 *  プロセッサ巴赂の介袋步
 */
void
cpu_initialize()
{
	/*
	 *  タスクコンテキストでの充哈みマスクの介袋步
	 */
#ifdef SUPPORT_CHG_IPM
	task_intmask = 0x0000;
#endif /* SUPPORT_CHG_IPM */

	/*
	 *  充哈み】CPU毋嘲ネストカウンタの介袋步
	 */
	intnest = 1;

#ifndef WITH_STUB

	/*
	 * 充り哈みコントロ〖ラの介袋步
	 */
	*IPRA = 0x0000;
	*IPRB = 0x0000;
	*IPRC = 0x0000;
	*IPRD = 0x0000;
	*IPRE = 0x0000;

#endif	/*  WITH_STUB  */

#ifndef CQ_SH1_DEB
#ifdef EXCVT_KERNEL
	/*
	 *  ベクタテ〖ブルの介袋步
	 */
	memcpy(EXCVT_KERNEL, EXCVT_ORIG, EXCVT_SIZE*sizeof(VP));
	
	/*
	 *  ベクタベ〖スレジスタの介袋步
	 */
	set_vbr(EXCVT_KERNEL);
#endif /* EXCVT_KERNEL */
#endif /* CQ_SH1_DEB */

}



/*
 *  プロセッサ巴赂の姜位借妄
 */
void
cpu_terminate()
{
#ifdef EXCVT_KERNEL
	set_vbr(EXCVT_ORIG);
#endif /* EXCVT_KERNEL */
}

#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 */


/*
 * 判峡されていない毋嘲が券栏すると钙び叫される
 */
void cpu_experr(EXCSTACK *sp)
{
    syslog(LOG_EMERG, "Exception error occurs.");

    syslog(LOG_EMERG, "PC = %08x SR = %08x PR = %08x",
    			sp->pc, sp->sr, sp->pr);

    syslog(LOG_EMERG, "r0 = %08x r1 = %08x r2 = %08x",
    			sp->r0, sp->r1, sp->r2);
    syslog(LOG_EMERG, "r3 = %08x r4 = %08x r5 = %08x",
    			sp->r3, sp->r4, sp->r5);
    syslog(LOG_EMERG, "r6 = %08x r7 = %08x r8 = %08x",
    			sp->r6, sp->r7, sp->r8);
    syslog(LOG_EMERG, "r9 = %08x r10 = %08x r11 = %08x",
    			sp->r9, sp->r10, sp->r11);
    syslog(LOG_EMERG, "r12 = %08x r13 = %08x r14 = %08x",
    			sp->r12, sp->r13, sp->r14);
    			/*  毋嘲券栏木涟のスタックポインタの猛  */
    syslog(LOG_EMERG, "r15 = %08x", (sp->r15)+19*4);

    while(1);
}


/*
 *  メモリブロック拎侯ライブラリ
 *	(ItIsからの萎脱)
 *
 *  簇眶の慌屯は·ANSI C ライブラリの慌屯と票じˉ筛洁ライブラリのものを
 *  蝗った数が跟唯が紊い材墙拉があるˉ
 *
 */
VP
_dummy_memcpy(VP dest, VP src, UINT len)
{
	VB	*d = dest;
	VB	*s = src;

	while (len-- > 0) {
		*d++ = *s++;
	}
	return(dest);
}