cpu_support.sh

toppers操作系统源码

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


#define _MACRO_ONLY
#include "jsp_kernel.h"
#include "offset.h"
#include <t_config.h>
 			

/*GHS アセンブラ导击炭吾恃垂*/
#define	long	data.l
#define	org	offset

/*GHS ROMモニタ充り哈みエントリ〖アドレス*/
#ifdef 	GHS_STUB
#define	_CpuExceptionHandler	0xa0000848
#endif


/*
 *  毋嘲/充り哈み叫掐り庚借妄ル〖チン
 *  SH3はベクタテ〖ブルを积たず、毋嘲,TRAPAが券栏するとVBR+0x100戎孟を、
 *  柒婶/嘲婶/NMI充り哈みが券栏すると、VBR+0x600戎孟を悸乖する。
 */
        
/*
 *	VBR に肋年する猛
 */
    .section .text
    .align 2        
    .global _BASE_VBR
_BASE_VBR:
     bra _start
     nop
     nop
     nop

/*
 *  Exception 100 vector
 *  アドレスエラ〖,スロット稍碰炭吾毋嘲、Trapa毋嘲霹が券栏すると悸乖される。
 *
 *  CPU毋嘲ハンドラは、润タスクコンテキストで悸乖する、そのため、CPU毋嘲ハン
 *  ドラを钙び叫す涟に毋嘲/充り哈みを绩すレジスタバンク1の r7 レジスタをイン
 *  クメントし、リタ〖ンしてきた稿にデクリメントする。CPU毋嘲がタスクコンテキ
 *  ストで券栏し、regflg が TRUE になった箕に、 ret_exc へ尸呆する。
 *  regflg をチェックする涟に充り哈みを敦贿しないと、reqflg をチェック稿に弹
 *  瓢された充り哈みハンドラ柒でディスパッチが妥滇された眷圭に、ディスパッチ
 *  されない。
 *
 *		
 *  毋嘲が券栏すると、毋嘲券栏傅のコンテキストであるspc,pr,ssr,r0×r7を锣闰
 *  する。毋嘲が券栏した箕爬でのコンテキストを拇べ润タスクコンテキストなら
 *  _exception_from_intから悸乖を倡幌する。毋嘲の妥傍はEXPEVTレジスタ粕み、
 *  exc_tableからCPU毋嘲ハンドラの倡幌戎孟を粕み哈む。券栏した毋嘲に滦して
 *  CPU毋嘲ハンドラが判峡されていなければ、_no_reg_exceptionにブランチして、
 *  ssr,sr,spc,prの柒推を叫蜗して匿贿する。CPU毋嘲ハンドラからリタ〖ンして
 *  きたら、reqflgを拇べ0笆嘲ならrec_exc()に若び、0なら傅の借妄にリタ〖ンす
 *  る。
 *
 *
 *  BLビットの胺いについて
 *  ssr,spc に提り黎のコンテキストを提して rte を券乖する狠には·充哈み∈NMI 
 *  も崔む∷を减け烧けないように BL ビットを1にする涩妥があるˉ毋嘲/充哈みハ
 *  ンドラ姜位箕には BL をビットを1にせず IPM を MAX_IPM に肋年するˉこれは·
 *  BL ビットが1の眷圭に毋嘲が券栏すると CPU がリセットされることを雇胃して·
 *  奥链のため·ssr,spcを牲耽する木涟でBLを1に肋年しているˉ
 *       
 */	
			

    .org   0x0100              /*  _BASE_VBR + 0x0100戎孟に芹弥   */
    .align 2
    .global _general_exception
_general_exception:
#ifdef GHS_STUB /* GHS */
	mov.l	r0,@-r15
	mov.l	r1,@-r15
	mov.l   _expevt,r0
	mov.l   @r0,r1     
	shlr2   r1           
	shlr    r1
	mov.l   _exc_table_exc,r0
	mov.l   @(r0,r1),r0        
	tst     r0,r0
	mov.l	@r15+,r1	
	mov.l	@r15+,r0
	bt      _rom_exception   /* _rom_exceptionへジャンプ             */
#endif
 /* spc,pr,ssr をスタックに瘦赂する */
    stc.l  spc,@-r15          
    sts.l  pr,@-r15               
    stc.l  ssr,@-r15
    stc.l  gbr,@-r15					
    sts.l  macl,@-r15					
    sts.l  mach,@-r15
    stc.l  r0_bank,@-r15 /* 毋嘲券栏箕のr0×r7を瘦赂        */    
    stc.l  r1_bank,@-r15
    stc.l  r2_bank,@-r15
    stc.l  r3_bank,@-r15
    stc.l  r4_bank,@-r15
    stc.l  r5_bank,@-r15
    stc.l  r6_bank,@-r15    
    stc.l  r7_bank,@-r15
    tst    r7,r7               /* 毋嘲券栏傅のコンテキストを冉年            */
    bf/s   _exception_from_exc /* 券栏傅が毋嘲/充り哈みハンドラならジャンプ */
     add    #0x01,r7	       /* 毋嘲/充り哈みネスト搀眶をインクリメント   */
    mov    r15,r1              /* 提り黎が充り哈みハンドラでないのでスタッ  */
    mov.l  _stacktop_exc,r15   /* クを掐れ仑え傅のスタックポインタを瘦赂    */ 
    mov.l r1,@-r15            
#ifdef GHS_HOOK
	mov.l   r1,@-r15
	mov.l   r7,@-r15
	stc     spc,r0
	mov.l   r0,r5
	mov.l   _expevt,r0        /* 充り哈み钓材すると久えるレジスタを瘦赂    */
	mov.l   _exception_hook_dis,r2
	jsr     @r2
	mov.l   @r0,r4            /* EXPEVTレジスタを艰评		              */
	mov.l   @r15+,r7
	mov.l   @r15+,r1
#endif

    mov.l  _expevt,r0          /* 毋嘲を钓材すると久えるレジスタを瘦赂      */
    mov.l  @r0,r5              /* EXPEVTレジスタを艰评                      */
    ldc    r1,r4_bank          /* CPU毋嘲ハンドラへの苞眶                   */
    ldc    r5,r5_bank	     
    mov.l  _unmak_rb_bl_exc,r2 /* BLビットを0に·レジスタバンクを磊り仑え   */
    stc    sr,r3               
    and    r3,r2			
    ldc    r2,sr               
    shlr2  r5                  /* EXPEVTを3ビット宝シフト                   */
    shlr   r5                
    mov.l  _exc_table_exc,r0   /* exc_tableのアドレスをr0に                 */
    mov.l  @(r0,r5),r2         /* ハンドラのアドレスを艰评                  */
    tst    r2,r2               /* ハンドラが判峡されていない毋嘲なら        */
    bt     _no_reg_exception   /* no_reg_exceptionへジャンプ                */
    jsr    @r2                 /* CPU毋嘲ハンドラへ                         */
     nop
    mov.l  _mask_md_ipm_exc,r0
    ldc    r0,sr               /* 充り哈み敦贿                              */
    stc    r7_bank,r7          /* 毋嘲/充り哈みのネスト搀眶をデクリメント   */
    dt     r7
    ldc    r7,r7_bank
    mov.l  _reqflg_exc,r2      /* reqflgのチェック                          */
    mov.l  @r2,r1
    tst    r1,r1               /* reqflgがFALSEならret_to_task_excに若び    */
    bt/s   _ret_to_task_exc    /* タスクに提る                              */
     mov.l  @r15,r15           /* 提り黎がタスクなのでスタックを提す        */
    xor    r0,r0               
    bra    ret_exc
     mov.l  r0,@r2             /* reqflgをクリア                            */


/*
 *   exception_from_int
 *   CPU毋嘲券栏箕のコンテキストが润タスクコンテキストの眷圭の借妄
 *   タスクコンテキストの眷圭との借妄の般いは、とCPU毋嘲ハンドラの
 *   借妄が姜位すると涩ず傅の借妄に提ることである。
 */
	
_exception_from_exc:
#ifdef GHS_HOOK
	mov.l   r7,@-r15
	stc     spc,r0
	mov.l   r0,r5
	mov.l   _expevt,r0       /* 充り哈み钓材すると久えるレジスタを瘦赂    */
	mov.l   _exception_hook_dis,r2
	jsr     @r2
	mov.l   @r0,r4           /* EXPEVTレジスタを艰评                      */
	mov.l   @r15+,r7
	
#endif
    mov.l   _expevt,r0        /* 毋嘲を钓材すると久えるレジスタを瘦赂      */
    mov.l   @r0,r5            /* EXPEVTレジスタを艰评                      */
    ldc     r15,r4_bank       /* CPU毋嘲ハンドラへの苞眶                   */
    ldc     r5,r5_bank	     
    mov.l   _unmak_rb_bl_exc,r2 /* BLビットを0に·レジスタバンクを磊り仑え */
    stc     sr,r3
    and     r3,r2			
    ldc     r2,sr               
    shlr2   r5                /* EXPECTを3ビット宝シフト                   */
    shlr    r5                	
    mov.l   _exc_table_exc,r0 /* exc_tableのアドレスをr0に                 */
    mov.l   @(r0,r5),r2       /* ハンドラのアドレスを艰评                  */
    tst     r2,r2             /* ハンドラが判峡されていない毋嘲なら        */
    bt      _no_reg_exception /* no_reg_exceptionへジャンプ                */
    jsr     @r2               /* CPU毋嘲ハンドラへ                         */
     nop
    mov.l  _mask_md_ipm_exc,r0
    ldc    r0,sr              /* BL=1,充り哈み敦贿                         */
    stc    r7_bank,r7         /* 毋嘲/充り哈みのネスト搀眶をデクリメント   */
    dt     r7
    ldc    r7,r7_bank
_ret_to_task_exc:
    mov.l  @r15+,r7           /* r0×r1,ssr,pr,spcを牲耽しタスクに提る     */
    mov.l  @r15+,r6
    mov.l  @r15+,r5
    mov.l  @r15+,r4
    mov.l  @r15+,r3
    mov.l  @r15+,r2
    mov.l  @r15+,r1        
    mov.l  _mask_md_bl_exc,r0 
    ldc    r0,sr             /* BLを1に                                   */
    mov.l  @r15+,r0
    lds.l  @r15+,mach                
    lds.l  @r15+,macl        
    ldc.l  @r15+,gbr               
    ldc.l  @r15+,ssr            
    lds.l  @r15+,pr
    ldc.l  @r15+,spc
    rte
     nop

#ifdef GHS_STUB /* GHS */
_rom_exception:
	stc.l	ssr,@-r15
	stc.l	spc,@-r15
	mov.l	r0,@-r15
	mov.l	r1,@-r15
	mov.l	L._CpuException1,r1
	jmp	@r1
	mov	#1,r0

	.align	4
L._CpuException1:
	.data.l	_CpuExceptionHandler
#endif

/*	
 *  no_reg_exception()
 *  CPU毋嘲として判峡されていない毋嘲が券栏すると钙び叫される
 *  毋嘲コ〖ド、毋嘲が券栏した箕爬のpc,sr,prを叫蜗してカ〖ネル
 *  を匿贿する。
 */					
_no_reg_exception:
    mov.l  _expevt,r5
    mov.l  @r5,r4
    stc    spc,r5
    stc    ssr,r6
    sts    pr,r7
    mov.l  _cpu_expevt_k,r1
    jsr    @r1
     nop

	.align  4
_stacktop_exc: