cpu_config.h

toppers操作系统源码

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