prom.S
193 lines
| 2.5 KiB
| text/S-plus
|
SLexer
r129 | ||||
/* Template boot-code for LEON3 test benches */ | ||||
#include "prom.h" | ||||
#ifndef STACKSIZE | ||||
#define STACKSIZE 0x00020000 | ||||
#endif | ||||
.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 | ||||
mov %g0, %asr16 | ||||
nop | ||||
set 0x81000f, %g1 | ||||
sta %g1, [%g0] 2 | ||||
mov %g0, %g2 | ||||
nop | ||||
nop | ||||
nop | ||||
nop | ||||
nop | ||||
or %g2, %g2, %g0 | ||||
nop | ||||
nop | ||||
nop | ||||
nop | ||||
nop | ||||
#ifdef DSUADDR | ||||
set DSUADDR, %g2 | ||||
st %g0, [%g2] | ||||
st %g0, [%g2+0x08] | ||||
st %g0, [%g2+0x20] | ||||
st %g0, [%g2+0x24] | ||||
st %g0, [%g2+0x40] | ||||
st %g0, [%g2+0x44] | ||||
st %g0, [%g2+0x50] | ||||
st %g0, [%g2+0x54] | ||||
st %g0, [%g2+0x58] | ||||
st %g0, [%g2+0x5C] | ||||
st %g0, [%g2+0x54] | ||||
#endif | ||||
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], %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 | ||||
ldd [%g3], %f30 | ||||
nop | ||||
nop | ||||
nop | ||||
nop | ||||
nop | ||||
faddd %f0, %f2, %f4 | ||||
nop | ||||
nop | ||||
nop | ||||
nop | ||||
ba 1f | ||||
nop | ||||
.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] | ||||
#ifdef DDR2CTRLIO | ||||
set DDR2CTRLIO, %g1 | ||||
set DDR2CFG4, %g2 | ||||
st %g2, [%g1+12] | ||||
#endif | ||||
#ifdef ASDCFG | ||||
#ifndef SDCTRLPNP | ||||
#define SDCTRLPNP 0xFFFFF860 | ||||
#endif | ||||
set SDCTRLPNP, %g1 | ||||
ld [%g1], %g2 | ||||
srl %g2, 12, %g2 | ||||
set 0x01009, %g1 | ||||
subcc %g1, %g2, %g0 | ||||
bne 1f | ||||
set ASDCFG, %g1 | ||||
set DSDCFG, %g2 | ||||
st %g2, [%g1] | ||||
#endif | ||||
! %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 0x88100000, %g2 ! restore data that was zapped by calibration | ||||
! set 0x0910006d, %g3 | ||||
! std %g2, [%g1] | ||||
jmp %g1 | ||||
nop | ||||
.align 32 | ||||