sys_support.s

uItron 4.0 Toppers实现源码1.4版

/*
 *  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
 * 
 *  惧淡螟侯涪荚は·笆布の (1)×(4) の掘凤か·Free Software Foundation 
 *  によって给山されている GNU General Public License の Version 2 に淡
 *  揭されている掘凤を塔たす眷圭に嘎り·塑ソフトウェア∈塑ソフトウェア
 *  を猖恃したものを崔むˉ笆布票じ∷を蝗脱ˇ剩澜ˇ猖恃ˇ浩芹邵∈笆布·
 *  网脱と钙ぶ∷することを痰浸で钓满するˉ
 *  (1) 塑ソフトウェアをソ〖スコ〖ドの妨で网脱する眷圭には·惧淡の螟侯
 *      涪山绩·この网脱掘凤および布淡の痰瘦沮惮年が·そのままの妨でソ〖
 *      スコ〖ド面に崔まれていることˉ
 *  (2) 塑ソフトウェアを·ライブラリ妨及など·戮のソフトウェア倡券に蝗
 *      脱できる妨で浩芹邵する眷圭には·浩芹邵に燃うドキュメント∈网脱
 *      荚マニュアルなど∷に·惧淡の螟侯涪山绩·この网脱掘凤および布淡
 *      の痰瘦沮惮年を非很することˉ
 *  (3) 塑ソフトウェアを·怠达に寥み哈むなど·戮のソフトウェア倡券に蝗
 *      脱できない妨で浩芹邵する眷圭には·肌のいずれかの掘凤を塔たすこ
 *      とˉ
 *    (a) 浩芹邵に燃うドキュメント∈网脱荚マニュアルなど∷に·惧淡の螟
 *        侯涪山绩·この网脱掘凤および布淡の痰瘦沮惮年を非很することˉ
 *    (b) 浩芹邵の妨轮を·侍に年める数恕によって·TOPPERSプロジェクトに
 *        鼠桂することˉ
 *  (4) 塑ソフトウェアの网脱により木儡弄または粗儡弄に栏じるいかなる禄
 *      巢からも·惧淡螟侯涪荚およびTOPPERSプロジェクトを倘勒することˉ
 * 
 *  塑ソフトウェアは·痰瘦沮で捏丁されているものであるˉ惧淡螟侯涪荚お
 *  よびTOPPERSプロジェクトは·塑ソフトウェアに簇して·その努脱材墙拉も
 *  崔めて·いかなる瘦沮も乖わないˉまた·塑ソフトウェアの网脱により木
 *  儡弄または粗儡弄に栏じたいかなる禄巢に簇しても·その勒扦を砷わないˉ
 * 
 *  @(#) $Id: sys_support.S,v 1.6 2003/12/11 00:44:27 honda Exp $
 */

#define _MACRO_ONLY
#include "jsp_kernel.h"
#include <excalibur.h>
        




/*
 *  你レベルのタ〖ゲットシステム巴赂の介袋步
 *
 *  スタ〖トアップモジュ〖ルの面で·メモリ介袋步の涟に钙び叫されるˉ          
 */       

        .text
        .align 2
        .global hardware_init_hook
hardware_init_hook: 

#ifdef EXCALIBUR_PLL_INIT
/*
 * Excalibur 巴赂の介袋步. 
 */
        /*    
         *  PLLの介袋步
         */    
        /* Set N            */
        ldr     r0,=CLK_PLL1_NCNT
        ldr     r1,=CLK_PLL1_NCNT_VAL
        str     r1,[r0]
        
        ldr     r0,=CLK_PLL2_NCNT
        ldr     r1,=CLK_PLL2_NCNT_VAL
        str     r1,[r0]
        
        /* Set M            */
        ldr     r0,=CLK_PLL1_MCNT
        ldr     r1,=CLK_PLL1_MCNT_VAL
        str     r1,[r0]

        ldr     r0,=CLK_PLL2_MCNT
        ldr     r1,=CLK_PLL2_MCNT_VAL
        str     r1,[r0]        

        /* Set K            */
        ldr     r0,=CLK_PLL1_KCNT
        ldr     r1,=CLK_PLL1_KCNT_VAL
        str     r1,[r0]

        ldr     r0,=CLK_PLL2_KCNT
        ldr     r1,=CLK_PLL2_KCNT_VAL
        str     r1,[r0]                        

        
        /* Start PLL1       */
        ldr     r0,=CLK_PLL1_CTRL
        ldr     r1,=CLK_PLL1_CTRL_VAL
        str     r1,[r0]
        
        ldr     r0,=CLK_PLL2_CTRL
        str     r1,[r0]
        
    
        /* Clear PLL1 and PLL2 bypass bit */    
        ldr     r0,=CLK_DERIVE
//        ldr     r1,=0x2010
        ldr     r1,=0x10
        str     r1,[r0]        

        /* Wait PLL to lock     */
        ldr     r0,=CLK_STATUS
1:
        ldr     r1,[r0]
//        cmp     r1,#0x15
        cmp     r1,#0x3f
        bne     1b
        
        /* Clear interrupt bit */
        ldr     r1,=0xC
        str     r1,[r0]


        /* Setup Stripe IO    */
        /* use UART           */
        ldr     r0,=IOCR_UART
        ldr     r1,=IOCR_UART_VAL
        str     r1,[r0]        

#endif /* EXCALIBUR_PLL_INIT */

        /* 
         * Cache ON 
         * ICache のみONにするˉ        
         */
        ldr     r0, =CP5_NO1_VAL
        mcr     p15, 0, r0, c1, c0, 0

       /*
        *  バスの肋年
        */
        ldr     r0, =AHB12B_CR
        ldr     r1, =AHB12B_CR_VAL
        str     r1, [r0]                


       /*
        *  PLDのコンフィギュレ〖ション
        *  sbiファイルがリンクされていれば(sbi_data_start != 0)
        *  sbiファイルによりPLDをコンフィギュレ〖ションするˉ
        */
        ldr     r0, =sbi_data_start
        cmp     r0, #0x00
        beq     init_done

        /* 
         * コンフィギュレ〖ションクロックの肋年
         */
        ldr     r0,=CONFIG_CLOCK
        ldr     r1,=CONFIG_CLOCK_DATA
        str     r1,[r0]

        /*
         * ロックされているかチェック
         */
check_pld_lock:
        ldr     r0,=CONFIG_CONTROL
        ldr     r1,[r0]
        and     r2,r1, #0x01    /* ロックビット(ビット0)が惟っているか */
        cmp     r2, #0x01       /* チェック                            */
        bne     1f
        ldr     r0,=CONFIG_UNLOCK       /* アンロック */
        ldr     r1,=CONFIG_UNLOCK_MAGIC
        str     r1,[r0]
        b       check_pld_lock          /* もう办刨チェック */

1:
        ldr     r0,=CONFIG_CONTROL
        ldr     r1,[r0]
        orr     r2, r1, #CONFIG_CONTROL_CO     /* COビットをセット */
        str     r2, [r0]

        /*
         *   IDCODE のチェック
         */
        ldr     r0, =sbi_data_start
        ldr     r1, =IDCODE
        ldr     r2, [r1]                /* load IDCODE from chip */
        ldr     r3, [r0, #4]            /* load IDCODE from sbi  */
        cmp     r3, r2
        bne     sbi_error

        ldmia   r0, {r1-r4}              /* load first 4 word     */
        add     r3, r3, r0               /* オフセットを颅す      */
        add     r0, r3, r4               /* 姜位アドレスを滇める  */
        
        ldr     r2, =CONFIG_DATA
        ldr     r4, =CONFIG_CONTROL


pld_busy_loop:
        /*
         *  バスアクセスをしないビジ〖ル〖プ
         */
/*
        mov     r1, #PLD_LOOP
pld_loop:
        subs    r1, r1, #1
        bpl     pld_loop        
*/
        ldr     r6, [r4]
        and     r7, r6, #CONFIG_CONTROL_BB
        cmp     r7, #CONFIG_CONTROL_BB
        beq     pld_busy_loop

pld_config_loop:
        ldr     r1, [r3], #0x04
        str     r1, [r2]
    
        cmp     r3,r0
        bne     pld_busy_loop


pld_wait_co_clear:
        ldr     r8, [r4]
        and     r6, r8, #CONFIG_CONTROL_CO
        cmp     r6, #CONFIG_CONTROL_CO
        beq     pld_wait_co_clear

        /*
         * エラ〖ビットのチェック
         */
        and     r7, r8, #CONFIG_CONTROL_E
        cmp     r7, #CONFIG_CONTROL_E
        beq     pld_error
        b       init_done

sbi_error:
        
pld_error:
        b sbi_error

init_done:
        mov     pc, lr



 


/*
 *
 *  充哈みの叫掐り庚借妄
 *         
 */        
        .text
        .align 4    
        .global IRQ_Handler
IRQ_Handler:

        /* 
         * 充哈みモ〖ド 
         * 
         * cpsrがspsr_irqに牲耽黎がr14_irq(lp)に掐り·
         * spsr_irqとr14_irqとr13(sp)_irqが r14,r13となるˉ
         */

        /* 
         *  タスクの瓢侯箕モ〖ド(ス〖パ〖バイザ〖モ〖ド)へ
         */
		mov   sp,#(CPSR_SVC | CPSR_FIQ_BIT | CPSR_IRQ_BIT) 
        msr   cpsr_all, sp
        stmfd sp!, {r0-r3,ip,lr,pc} /* pcはダミ〖 */


  
        /*
         * spsrと提り戎孟を艰评するためにIRQモ〖ドへ
         */
		mov   r0,#(CPSR_IRQ | CPSR_FIQ_BIT | CPSR_IRQ_BIT)
        msr   cpsr,r0
        sub   r0,lr,#4
        mrs   r1,spsr
   
        /*
         *  ス〖パ〖バイザ〖モ〖ドに
         */
        msr   cpsr_all, sp
        str   r0, [sp,#0x18] /* Store pc */
        stmfd sp!,{r1}       /* spsr */


        /*
         *  驴脚充り哈みか冉年
         */
        ldr     r2, =interrupt_count
        ldr     r3, [r2]
        add     r0,r3,#1
        str     r0, [r2]
        cmp     r3, #0x00

        moveq   r2,sp            /* ネスト充り哈みでない眷圭 */
        ldreq   sp,=STACKTOP     /* スタックの恃构    */
        stmeqfd sp!,{r2}         /* タスクスタックの瘦赂 */


        /*
         *  充り哈み妥傍の冉年ˉ
         *  INT_IDの粕み哈みˉ(ここにある涩妥はないˉ)
         */
        ldr     r0,  =INT_ID
        ldr     r1,  [r0]

        mov     r2,  r1,lsl #2        /* テ〖ブルのオフセットを栏喇    */
        ldr     r3,  =int_mask_table  /* 充哈みマスクテ〖ブルの钙び叫し*/
        ldr     r1,  [r3,r2]          /* r0<-充哈みマスク              */    
        ldr     r0,  =INT_MASK_CLEAR  /* 充哈みレジスタへのセット      */
        str     r1,  [r0]               
        stmfd   sp!, {r1}             /* マスクビットを瘦赂(涩妥か々)  */
        ldr     r3,  =int_table       /* 充哈み悼击テ〖ブルの粕み叫し  */
        ldr     r0,  [r3,r2]

        /*
         *  踏年盗の充哈みかチェック
         */
        cmp     r0, #0x00
        beq     undefined_interrupt
        
        /* 
         * 充り哈み钓材 
         */                
        mov     r2,#(CPSR_SVC|CPSR_FIQ_BIT)
        msr     cpsr,r2

        /* 
         * Call Handler  
         */        
        mov     lr,  pc   
        mov     pc,  r0

        /* 
         * 充り哈み敦贿 
         */
        mov     r2,#(CPSR_SVC|CPSR_FIQ_BIT|CPSR_IRQ_BIT) 
        msr     cpsr,r2

        ldmfd   sp!, {r0}                 /* ペンディングビットの牲耽 */
        ldr     r2,  =INT_MASK_SET        /* 充り哈み钓材             */
        str     r0,  [r2]                

        /* 
         * 充哈みネスト搀眶(interrupt_count) デクリメント 
         */
        ldr     r2, =interrupt_count
        ldr     r1, [r2]        
        sub     r3, r1, #1                        
        str     r3, [r2]
        cmp     r3, #0x00        
        bne     return_to_task_irq
        
        /* 
         * タスクスタックの牲耽 
         */
        ldmfd   sp!,{r0}         
        mov     sp, r0        
                
        ldr     r1, =reqflg    /* Check reqflg */
        ldr     r0, [r1]
        cmp     r0, #0
        beq     return_to_task_irq
        mov     r0, #0
        str     r0, [r1]       /* Clear reqflg */
        b       ret_int

return_to_task_irq:
        /*
         *  牲耽借妄
         *  充り哈み钓材となるがタスクコンテキスト惧に瘦赂しているため·
         *  啼玛はない
         */
        ldmfd   sp!,{r1}           /* CPSRの牲耽借妄 */
        msr     spsr, r1           /* 充り哈み钓材   */
        ldmfd   sp!,{r0-r3,ip,lr,pc}^ /*タスク牲耽 + 充哈み钓材 */

        /*
         *  踏年盗の充哈みが掐ったときに钙び叫す
         */    
undefined_interrupt:
         b      undef_interrupt