cpu_config.h

嵌入式系统开发 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.h,v 1.9 2002/04/05 07:43:51 honda Exp $
 */

/*
 *	プロセッサ巴赂モジュ〖ル∈ARM7TDMI脱∷
 */
#ifndef _CPU_CONFIG_H_
#define _CPU_CONFIG_H_

/*
 *  カ〖ネルの柒婶急侍叹のリネ〖ム
 */
#ifndef OMIT_RENAME

#define activate_r      _kernel_activate_r
#define ret_int         _kernel_ret_int
#define ret_exc         _kernel_ret_exc

#ifdef LABEL_ASM

#define _activate_r     __kernel_activate_r
#define _ret_int        __kernel_ret_int
#define _ret_exc        __kernel_ret_exc

#endif /* LABEL_ASM */
#endif /* OMIT_RENAME */

/*
 *  プロセッサの泼检炭吾のインライン簇眶年盗
 */
#ifndef _MACRO_ONLY
#include "cpu_insn.h"
#endif /* _MACRO_ONLY */

/*
 *  TCB 簇息の年盗
 *
 *  cpu_context.h に掐れる数がエレガントだが·徊救の巴赂拉の簇犯で·
 *  cpu_context.h には掐れられないˉ
 */

/*
 *  TCB 面のフィ〖ルドのビット升の年盗
 */
#define	TBIT_TCB_TSTAT		8	/* tstat フィ〖ルドのビット升 */
#define	TBIT_TCB_PRIORITY	8	/* priority フィ〖ルドのビット升 */

#ifndef _MACRO_ONLY
/*
 *  タスクコンテキストブロックの年盗
 */
typedef struct task_context_block {
	VP	sp;		/* スタックポインタ */
	FP	pc;		/* プログラムカウンタ */
} CTXB;

/*
 * 充り哈みのネスト搀眶のカウント
 */
extern UW interrupt_count;


/*
 *  システム觉轮徊救
 */
Inline UB
current_mode()
{
    return(current_sr() & CPSR_MODE_MASK);
}

Inline BOOL
sense_context()
{
	return(interrupt_count > 0);
}

Inline BOOL
sense_lock()
{
	return(current_sr() & CPSR_IRQ_BIT);
}

#define t_sense_lock	sense_lock
#define i_sense_lock	sense_lock


/*
 *  CPUロックとその豺近
 *
 */

#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 void
lock_cpu()
{
	disint();
}

Inline void
unlock_cpu()
{
	enaint();
}


/*
 *  タスクディスパッチャ
 */

/*
 *  呵光庭黎界疤タスクへのディスパッチ∈cpu_support.S∷
 *
 *  dispatch は·タスクコンテキストから钙び叫されたサ〖ビスコ〖ル借妄
 *  柒で·CPUロック觉轮で钙び叫さなければならないˉ
 */
extern void	dispatch(void);


/*
 *  附哼のコンテキストを嘉ててディスパッチ∈cpu_support.S∷
 *
 *  exit_and_dispatch は·CPUロック觉轮で钙び叫さなければならないˉ
 */
extern void	exit_and_dispatch(void);


/*
 * 毋嘲ベクタに今き哈まれたジャンプ炭吾が徊救するアドレス
 */
extern UW *arm_vector_add[8];


/*
 * 毋嘲に炳じたハンドラの弹瓢戎孟
 */
extern UW arm_handler_add[8];


/*
 *  CPU毋嘲ハンドラの肋年
 */
extern void define_exc(EXCNO excno, FP exchdr);


Inline void
arm_install_handler(EXCNO excno, FP exchdr)
{
    *arm_vector_add[excno] = (UW)exchdr;
}


/*
 *  CPU毋嘲ハンドラの叫掐庚借妄
 */


/*
 *  CPU毋嘲ハンドラの叫掐庚借妄の栏喇マクロ
 *
 */
#define __EXCHDR_ENTRY(exchdr, stacktop)    \
extern void exchdr##_entry(VP sp);          \
asm(".text                             \n"  \
#exchdr "_entry:                       \n"  \
"       ldr   sp,.int_stack_"#exchdr"  \n"  /* スタックの磊り仑え        */\
"       sub   lr,lr,#4                 \n"  /* undefでもこれでいいか?    */\
"       stmfd sp!, {r0 - r2,lr}        \n"  /* 办箕弄にint_stackに略闰   */ \
"       mrs   r0, spsr                 \n"  /* SYSモ〖ドに磊り仑えるため */ \
"       mov   r1, sp                   \n"  /* 瘦赂する                  */ \
"       mov   r2,#0xdf                 \n"  /* CPSRの今き垂え            */ \
"       msr   cpsr,r2                  \n" \
"       ldr   r2,[r1,#0x0C]            \n"     /* load  PC            */\
"       stmfd sp!,{r2}                 \n"     /* Store PC            */\
"       stmfd sp!,{r3,ip,lr}           \n"     /* Store r3,ip,lr      */\
"       ldmfd r1!,{r2,ip,lr}	       \n"     /* load  r0,r1,r2      */\
"       stmfd sp!,{r0,r2,ip,lr}        \n"     /* SPSR,Store r0,r1,r2 */\
"       ldr  r2, .interrupt_count_"#exchdr"\n" /* 驴脚充り哈みか冉年  */\
"       ldr  r3, [r2]                  \n" \
"       add  r0,r3,#1                  \n" \
"       str  r0, [r2]                  \n" \
"       mov  r0,sp                     \n" /* 毋嘲ハンドラへの苞眶 */\
"       cmp  r3, #0x00                 \n" \
"       ldreq   sp,stack_"#exchdr"     \n" /* スタックの恃构       */\
"       stmeqfd sp!,{r0}               \n" /* タスクスタックの瘦赂 */\
"       mov   r2,#0x1f                 \n" /* 充り哈み钓材         */\
"       msr   cpsr,r2                  \n" \
"		bl    "#exchdr"                \n" /* ハンドラ钙び叫し     */\
"       mov   r2,#0xdf                 \n" /* 充り哈み敦贿         */\
"       msr   cpsr,r2                  \n" \
"       ldr   r2,.interrupt_count_"#exchdr" \n"/* 充り哈み搀眶を   */\
"       ldr   r1, [r2]                 \n"     /* デクリメント     */\
"       sub   r3,r1,#1                 \n"\
"       str   r3, [r2]                 \n"\
"       cmp   r3,#0x00                 \n" /* 充り哈みネスト眶?    */\
"       bne   return_to_task_"#exchdr" \n" \
"       ldmfd sp!,{r0}                 \n" /* タスクスタックの牲耽 */\
"       mov   sp, r0                   \n"\
"		ldr   r1, reqflg_"#exchdr"     \n" /* Check reqflg         */\
"		ldr   r0,[r1]                  \n"\
"		cmp   r0,#0                    \n"\
"		beq   return_to_task_"#exchdr" \n"\
"       mov   r0,#0                    \n"\
"		str   r0,[r1]                  \n" /* Clear reqflg   */\
" 		b     _kernel_ret_exc          \n" /* ret_intへ      */\
"return_to_task_"#exchdr":             \n" \
"       ldmfd sp!,{r1}                 \n" /* CPSRの牲耽借妄 */\
"       msr   cpsr, r1                 \n" /* 充り哈み钓材   */\
"       ldmfd sp!,{r0-r3,ip,lr,pc}     \n"\
"       .align 4                       \n"\
".int_stack_"#exchdr":                 \n"\
"        .long int_stack + 6 * 4       \n"\
"reqflg_"#exchdr":                     \n"\
"		.long     _kernel_reqflg       \n"\
"stack_"#exchdr":                      \n"\
"        .long   " #stacktop "         \n"\
".interrupt_count_"#exchdr":           \n"\
"        .long   interrupt_count       \n")


#define _EXCHDR_ENTRY(exchdr, stacktop)    __EXCHDR_ENTRY(exchdr, stacktop)

#define EXCHDR_ENTRY(exchdr)    _EXCHDR_ENTRY(exchdr, STACKTOP)

#define EXC_ENTRY(exchdr) exchdr##_entry


/*
 *  CPU毋嘲の券栏した箕のシステム觉轮の徊救
 */

/*
 *  CPU毋嘲の券栏した箕のディスパッチ
 *  NotYet! 
 */
Inline BOOL
exc_sense_context(VP p_excinf)
{
	return(interrupt_count > 1);    
}

/*
 *  CPU毋嘲の券栏した箕のCPUロック觉轮の徊救
 *  NotYet! 
 */
Inline BOOL
exc_sense_lock(VP p_excinf)
{
    return((*((UW *)p_excinf) & CPSR_IRQ_BIT) == CPSR_IRQ_BIT );
}


/*
 *  ラベルの侍叹を年盗するためのマクロ
 */
#define	_LABEL_ALIAS(new_label, defined_label) \
	asm(".globl " #new_label "\n" #new_label " = " #defined_label);
#define LABEL_ALIAS(x, y) _LABEL_ALIAS(x, y)


/*
 *  プロセッサ巴赂の介袋步
 */
extern void	cpu_initialize(void);


/*
 *  プロセッサ巴赂の姜位箕借妄
 */
extern void	cpu_terminate(void);


/*
 * CPU/充哈みハンドラの叫掐り庚借妄で办箕弄に蝗脱するスタック
 */
#define INT_STACK_SIZE 6
extern UW int_stack[INT_STACK_SIZE];


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