Subversion Repositories mips_enhanced

/* Template boot-code for LEON3 test benches */

#ifndef STACKSIZE
#define STACKSIZE 0x00002000
#endif

#include "prom.h"

        .seg    "text"
        .proc   0
        .align  4
        .global start
start:

        flush
        set 0x10e0, %g1         ! init IU
        mov %g1, %psr
        mov %g0, %wim
        mov %g0, %tbr
        mov %g0, %y
        nop
        set  0x81000f, %g1
        sta %g1, [%g0] 2
2:
        mov %asr17, %g3
        and %g3, 0x1f, %g3
        mov %g0, %g4
        mov %g0, %g5
        mov %g0, %g6
        mov %g0, %g7
1:
        mov %g0, %l0
        mov %g0, %l1
        mov %g0, %l2
        mov %g0, %l3
        mov %g0, %l4
        mov %g0, %l5
        mov %g0, %l6
        mov %g0, %l7
        mov %g0, %o0
        mov %g0, %o1
        mov %g0, %o2
        mov %g0, %o3
        mov %g0, %o4
        mov %g0, %o5
        mov %g0, %o6
        mov %g0, %o7
        subcc %g3, 1, %g3
        bge 1b
        save

        mov     2, %g1
        mov     %g1, %wim
        set 0x10e0, %g1         ! enable traps
        mov %g1, %psr
        nop; nop; nop;

        mov %psr, %g1
        srl %g1, 12, %g1
        andcc %g1, 1, %g0
        be 1f
        nop

        set _fsrxx, %g3
        ld [%g3], %fsr
        ldd [%g3], %f0
        ldd [%g3], %f2
        ldd [%g3], %f4
        ldd [%g3+8], %f6
        ldd [%g3], %f8
        ldd [%g3], %f10
        ldd [%g3], %f12
        ldd [%g3], %f14
        ldd [%g3], %f16
        ldd [%g3], %f18
        ldd [%g3], %f20
        ldd [%g3], %f22
        ldd [%g3], %f24
        ldd [%g3], %f26
        ldd [%g3], %f28
        ba  1f
        ldd [%g3], %f30

.align  8
_fsrxx:
        .word 0
        .word 0

1:
        mov %asr17, %g3
        srl %g3, 28, %g3
        andcc %g3, 0x0f, %g3
        bne 1f

        set L2MCTRLIO, %g1
        set MCFG1, %g2
        st  %g2, [%g1]
        set MCFG2, %g2
        st  %g2, [%g1+4]
        set MCFG3, %g2
        st  %g2, [%g1+8]
!       set IRQCTRL, %g1
!       set 0x0ffff, %g2
!       st  %g2, [%g1+0x10]

        set 0xFFFFF880, %g1
        ld  [%g1], %g2
        srl %g2, 12, %g2
        set 0x01025, %g1
        subcc %g1, %g2, %g0
        bne 1f

/*
        set ASDCFG, %g1
!       set DSDCFG, %g2

        ld  [%g1], %g2
        ld  [%g1+4], %g2
        set 0x6b60830a, %g2
        st  %g2, [%g1]
        nop; nop; nop; nop; nop; nop; nop; nop
        set 0x6b68830a, %g2     ! precharge
        st  %g2, [%g1]
        nop; nop; nop; nop; nop; nop; nop; nop
        set 0x6b7c830a, %g2     ! load extended
        st  %g2, [%g1]
        nop; nop; nop; nop; nop; nop; nop; nop
        set 0x6b7a830a, %g2     ! load config
        st  %g2, [%g1]
        nop; nop; nop; nop; nop; nop; nop; nop
        set 0x6b68830a, %g2     ! precharge
        st  %g2, [%g1]
        nop; nop; nop; nop; nop; nop; nop; nop
        set 0x6b70830a, %g2     ! refresh
        st  %g2, [%g1]
        nop; nop; nop; nop; nop; nop; nop; nop
        set 0x6b70830a, %g2     ! refresh
        st  %g2, [%g1]
        nop; nop; nop; nop; nop; nop; nop; nop
        set 0x6b78830a, %g2     ! load config
        st  %g2, [%g1]
        nop; nop; nop; nop; nop; nop; nop; nop
        set 0xeb00830a, %g2     ! enable refresh counter
        st  %g2, [%g1]

        set 0x80000c00, %g4
        set 0x40000000, %g5
        st %g5, [%g4]
        add %g5, 0xf8, %g5
        st %g5, [%g4+4]
        set 0x1a0040, %g5
        st %g5, [%g4+8]
4:
        ba 4b
        nop
*/

        ! %g3 = cpu index
1:      set STACKSIZE, %g2
        mov %g0, %g1
2:      subcc %g3, 0, %g0
        be 3f
        nop                                                                     
        add %g1, %g2, %g1
        ba 2b
        sub %g3, 1, %g3         
                                

3:      set RAMSTART+ RAMSIZE-32, %fp
        sub %fp, %g1, %fp
        sub %fp, 96, %sp

        set RAMSTART, %g1

/*
        set 0x80000c00, %g2
        st %g1, [%g2]
        add %g1, 0x14, %g3
        st %g3, [%g2+4]
        set 0x1a08, %g3
        st %g3, [%g2+8]
*/
/*
        set 0x01000000, %g2
        set 0x01000000, %g3
        std %g2, [%g1]
        std %g2, [%g1+8]
        std %g2, [%g1+0x10]
        std %g2, [%g1+0x18]
        std %g2, [%g1+0x20]
        set 0x01234567, %g2
        set 0x89abcdef, %g3
        stb %g2, [%g1+12]
        stb %g3, [%g1+13]
        sth %g2, [%g1+14]
        st %g1, [%g1+8]
        std %g2, [%g1]
        ld  [%g1], %g4
        ld  [%g1+4], %g4
        ld  [%g1+8], %g4
        ld  [%g1+12], %g4
        ldub  [%g1+0], %g4
        ldub  [%g1+1], %g4
        ldub  [%g1+2], %g4
        ldub  [%g1+3], %g4
        lduh  [%g1+0], %g4
        lduh  [%g1+2], %g4

        ldd  [%g1], %g4

!       ba 3b

        nop
*/
        jmp %g1
        nop     

.align  32