/* Support file for c based tests */
|
/* Support file for c based tests */
|
|
|
#include "spr_defs.h"
|
#include "spr_defs.h"
|
#include "board.h"
|
#include "board.h"
|
|
|
#define reset _main
|
#define reset _main
|
|
|
#define MC_CSR (0x00)
|
#define MC_CSR (0x00)
|
#define MC_POC (0x04)
|
#define MC_POC (0x04)
|
#define MC_BA_MASK (0x08)
|
#define MC_BA_MASK (0x08)
|
#define MC_CSC(i) (0x10 + (i) * 8)
|
#define MC_CSC(i) (0x10 + (i) * 8)
|
#define MC_TMS(i) (0x14 + (i) * 8)
|
#define MC_TMS(i) (0x14 + (i) * 8)
|
|
|
.global _except_basic
|
.global _except_basic
|
.global _lo_dmmu_en
|
.global _lo_dmmu_en
|
.global _lo_immu_en
|
.global _lo_immu_en
|
.global _call
|
.global _call
|
.global _call_with_int
|
.global _call_with_int
|
.global _load_acc_32
|
.global _load_acc_32
|
.global _load_acc_16
|
.global _load_acc_16
|
.global _store_acc_32
|
.global _store_acc_32
|
.global _store_acc_16
|
.global _store_acc_16
|
.global _load_b_acc_32
|
.global _load_b_acc_32
|
.global _trap
|
.global _trap
|
.global _b_trap
|
.global _b_trap
|
.global _range
|
.global _range
|
.global _b_range
|
.global _b_range
|
.global _int_trigger
|
.global _int_trigger
|
.global _int_loop
|
.global _int_loop
|
.global _jump_back
|
.global _jump_back
|
|
|
.section .stack
|
.section .stack
|
.space 0x1000
|
.space 0x1000
|
_stack:
|
_stack:
|
|
|
.extern _reset_support
|
.extern _reset_support
|
.extern _c_reset
|
.extern _c_reset
|
.extern _excpt_buserr
|
.extern _excpt_buserr
|
.extern _excpt_dpfault
|
.extern _excpt_dpfault
|
.extern _excpt_ipfault
|
.extern _excpt_ipfault
|
.extern _excpt_tick
|
.extern _excpt_tick
|
.extern _excpt_align
|
.extern _excpt_align
|
.extern _excpt_illinsn
|
.extern _excpt_illinsn
|
.extern _excpt_int
|
.extern _excpt_int
|
.extern _excpt_dtlbmiss
|
.extern _excpt_dtlbmiss
|
.extern _excpt_itlbmiss
|
.extern _excpt_itlbmiss
|
.extern _excpt_range
|
.extern _excpt_range
|
.extern _excpt_syscall
|
.extern _excpt_syscall
|
.extern _excpt_break
|
.extern _excpt_break
|
.extern _excpt_trap
|
.extern _excpt_trap
|
|
|
.section .except, "ax"
|
.section .except, "ax"
|
|
|
_buserr_vector:
|
_buserr_vector:
|
l.addi r1,r1,-120
|
l.addi r1,r1,-120
|
l.sw 0x1c(r1),r9
|
l.sw 0x1c(r1),r9
|
l.sw 0x20(r1),r10
|
l.sw 0x20(r1),r10
|
l.movhi r9,hi(store_regs)
|
l.movhi r9,hi(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.movhi r10,hi(_excpt_buserr)
|
l.movhi r10,hi(_excpt_buserr)
|
l.ori r10,r10,lo(_excpt_buserr)
|
l.ori r10,r10,lo(_excpt_buserr)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
|
|
_dpfault_vector:
|
_dpfault_vector:
|
l.addi r1,r1,-120
|
l.addi r1,r1,-120
|
l.sw 0x1c(r1),r9
|
l.sw 0x1c(r1),r9
|
l.sw 0x20(r1),r10
|
l.sw 0x20(r1),r10
|
l.movhi r9,hi(store_regs)
|
l.movhi r9,hi(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.movhi r10,hi(_excpt_dpfault)
|
l.movhi r10,hi(_excpt_dpfault)
|
l.ori r10,r10,lo(_excpt_dpfault)
|
l.ori r10,r10,lo(_excpt_dpfault)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
|
|
_ipfault_vector:
|
_ipfault_vector:
|
l.addi r1,r1,-120
|
l.addi r1,r1,-120
|
l.sw 0x1c(r1),r9
|
l.sw 0x1c(r1),r9
|
l.sw 0x20(r1),r10
|
l.sw 0x20(r1),r10
|
l.movhi r9,hi(store_regs)
|
l.movhi r9,hi(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.movhi r10,hi(_excpt_ipfault)
|
l.movhi r10,hi(_excpt_ipfault)
|
l.ori r10,r10,lo(_excpt_ipfault)
|
l.ori r10,r10,lo(_excpt_ipfault)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
|
|
_tick_vector:
|
_tick_vector:
|
l.addi r1,r1,-120
|
l.addi r1,r1,-120
|
l.sw 0x1c(r1),r9
|
l.sw 0x1c(r1),r9
|
l.sw 0x20(r1),r10
|
l.sw 0x20(r1),r10
|
l.movhi r9,hi(store_regs)
|
l.movhi r9,hi(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.movhi r10,hi(_excpt_tick)
|
l.movhi r10,hi(_excpt_tick)
|
l.ori r10,r10,lo(_excpt_tick)
|
l.ori r10,r10,lo(_excpt_tick)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
|
|
_align_vector:
|
_align_vector:
|
l.addi r1,r1,-120
|
l.addi r1,r1,-120
|
l.sw 0x1c(r1),r9
|
l.sw 0x1c(r1),r9
|
l.sw 0x20(r1),r10
|
l.sw 0x20(r1),r10
|
l.movhi r9,hi(store_regs)
|
l.movhi r9,hi(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.movhi r10,hi(_excpt_align)
|
l.movhi r10,hi(_excpt_align)
|
l.ori r10,r10,lo(_excpt_align)
|
l.ori r10,r10,lo(_excpt_align)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
|
|
_illinsn_vector:
|
_illinsn_vector:
|
l.addi r1,r1,-120
|
l.addi r1,r1,-120
|
l.sw 0x1c(r1),r9
|
l.sw 0x1c(r1),r9
|
l.sw 0x20(r1),r10
|
l.sw 0x20(r1),r10
|
l.movhi r9,hi(store_regs)
|
l.movhi r9,hi(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.movhi r10,hi(_excpt_illinsn)
|
l.movhi r10,hi(_excpt_illinsn)
|
l.ori r10,r10,lo(_excpt_illinsn)
|
l.ori r10,r10,lo(_excpt_illinsn)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
|
|
_int_vector:
|
_int_vector:
|
l.addi r1,r1,-120
|
l.addi r1,r1,-120
|
l.sw 0x1c(r1),r9
|
l.sw 0x1c(r1),r9
|
l.sw 0x20(r1),r10
|
l.sw 0x20(r1),r10
|
l.movhi r9,hi(store_regs)
|
l.movhi r9,hi(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.movhi r10,hi(_excpt_int)
|
l.movhi r10,hi(_excpt_int)
|
l.ori r10,r10,lo(_excpt_int)
|
l.ori r10,r10,lo(_excpt_int)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
|
|
_dtlbmiss_vector:
|
_dtlbmiss_vector:
|
l.addi r1,r1,-120
|
l.addi r1,r1,-120
|
l.sw 0x1c(r1),r9
|
l.sw 0x1c(r1),r9
|
l.sw 0x20(r1),r10
|
l.sw 0x20(r1),r10
|
l.movhi r9,hi(store_regs)
|
l.movhi r9,hi(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.movhi r10,hi(_excpt_dtlbmiss)
|
l.movhi r10,hi(_excpt_dtlbmiss)
|
l.ori r10,r10,lo(_excpt_dtlbmiss)
|
l.ori r10,r10,lo(_excpt_dtlbmiss)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
|
|
_itlbmiss_vector:
|
_itlbmiss_vector:
|
l.addi r1,r1,-120
|
l.addi r1,r1,-120
|
l.sw 0x1c(r1),r9
|
l.sw 0x1c(r1),r9
|
l.sw 0x20(r1),r10
|
l.sw 0x20(r1),r10
|
l.movhi r9,hi(store_regs)
|
l.movhi r9,hi(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.movhi r10,hi(_excpt_itlbmiss)
|
l.movhi r10,hi(_excpt_itlbmiss)
|
l.ori r10,r10,lo(_excpt_itlbmiss)
|
l.ori r10,r10,lo(_excpt_itlbmiss)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
|
|
_range_vector:
|
_range_vector:
|
l.addi r1,r1,-120
|
l.addi r1,r1,-120
|
l.sw 0x1c(r1),r9
|
l.sw 0x1c(r1),r9
|
l.sw 0x20(r1),r10
|
l.sw 0x20(r1),r10
|
l.movhi r9,hi(store_regs)
|
l.movhi r9,hi(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.movhi r10,hi(_excpt_range)
|
l.movhi r10,hi(_excpt_range)
|
l.ori r10,r10,lo(_excpt_range)
|
l.ori r10,r10,lo(_excpt_range)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
|
|
_syscall_vector:
|
_syscall_vector:
|
l.addi r3,r3,4
|
l.addi r3,r3,4
|
|
|
l.mfspr r4,r0,SPR_SR
|
l.mfspr r4,r0,SPR_SR
|
l.andi r4,r4,7
|
l.andi r4,r4,7
|
l.add r6,r0,r4
|
l.add r6,r0,r4
|
|
|
l.mfspr r4,r0,SPR_EPCR_BASE
|
l.mfspr r4,r0,SPR_EPCR_BASE
|
l.movhi r5,hi(_sys1)
|
l.movhi r5,hi(_sys1)
|
l.ori r5,r5,lo(_sys1)
|
l.ori r5,r5,lo(_sys1)
|
l.sub r5,r4,r5
|
l.sub r5,r4,r5
|
|
|
l.mfspr r4,r0,SPR_ESR_BASE /* ESR - set supvisor mode */
|
l.mfspr r4,r0,SPR_ESR_BASE /* ESR - set supvisor mode */
|
l.ori r4,r4,SPR_SR_SM
|
l.ori r4,r4,SPR_SR_SM
|
l.mtspr r0,r4,SPR_ESR_BASE
|
l.mtspr r0,r4,SPR_ESR_BASE
|
|
|
l.movhi r4,hi(_sys2)
|
l.movhi r4,hi(_sys2)
|
l.ori r4,r4,lo(_sys2)
|
l.ori r4,r4,lo(_sys2)
|
l.mtspr r0,r4,SPR_EPCR_BASE
|
l.mtspr r0,r4,SPR_EPCR_BASE
|
|
|
l.rfe
|
l.rfe
|
l.addi r3,r3,8
|
l.addi r3,r3,8
|
|
|
_break_vector:
|
_break_vector:
|
l.addi r1,r1,-120
|
l.addi r1,r1,-120
|
l.sw 0x1c(r1),r9
|
l.sw 0x1c(r1),r9
|
l.sw 0x20(r1),r10
|
l.sw 0x20(r1),r10
|
l.movhi r9,hi(store_regs)
|
l.movhi r9,hi(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.movhi r10,hi(_excpt_break)
|
l.movhi r10,hi(_excpt_break)
|
l.ori r10,r10,lo(_excpt_break)
|
l.ori r10,r10,lo(_excpt_break)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
|
|
_trap_vector:
|
_trap_vector:
|
l.addi r1,r1,-120
|
l.addi r1,r1,-120
|
l.sw 0x1c(r1),r9
|
l.sw 0x1c(r1),r9
|
l.sw 0x20(r1),r10
|
l.sw 0x20(r1),r10
|
l.movhi r9,hi(store_regs)
|
l.movhi r9,hi(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.ori r9,r9,lo(store_regs)
|
l.movhi r10,hi(_excpt_trap)
|
l.movhi r10,hi(_excpt_trap)
|
l.ori r10,r10,lo(_excpt_trap)
|
l.ori r10,r10,lo(_excpt_trap)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
|
|
.section .text
|
.section .text
|
|
|
.org 0x100
|
.org 0x100
|
_reset_vector:
|
_reset_vector:
|
l.nop
|
l.nop
|
l.nop
|
l.nop
|
l.addi r2,r0,0x0
|
l.addi r2,r0,0x0
|
l.addi r3,r0,0x0
|
l.addi r3,r0,0x0
|
l.addi r4,r0,0x0
|
l.addi r4,r0,0x0
|
l.addi r5,r0,0x0
|
l.addi r5,r0,0x0
|
l.addi r6,r0,0x0
|
l.addi r6,r0,0x0
|
l.addi r7,r0,0x0
|
l.addi r7,r0,0x0
|
l.addi r8,r0,0x0
|
l.addi r8,r0,0x0
|
l.addi r9,r0,0x0
|
l.addi r9,r0,0x0
|
l.addi r10,r0,0x0
|
l.addi r10,r0,0x0
|
l.addi r11,r0,0x0
|
l.addi r11,r0,0x0
|
l.addi r12,r0,0x0
|
l.addi r12,r0,0x0
|
l.addi r13,r0,0x0
|
l.addi r13,r0,0x0
|
l.addi r14,r0,0x0
|
l.addi r14,r0,0x0
|
l.addi r15,r0,0x0
|
l.addi r15,r0,0x0
|
l.addi r16,r0,0x0
|
l.addi r16,r0,0x0
|
l.addi r17,r0,0x0
|
l.addi r17,r0,0x0
|
l.addi r18,r0,0x0
|
l.addi r18,r0,0x0
|
l.addi r19,r0,0x0
|
l.addi r19,r0,0x0
|
l.addi r20,r0,0x0
|
l.addi r20,r0,0x0
|
l.addi r21,r0,0x0
|
l.addi r21,r0,0x0
|
l.addi r22,r0,0x0
|
l.addi r22,r0,0x0
|
l.addi r23,r0,0x0
|
l.addi r23,r0,0x0
|
l.addi r24,r0,0x0
|
l.addi r24,r0,0x0
|
l.addi r25,r0,0x0
|
l.addi r25,r0,0x0
|
l.addi r26,r0,0x0
|
l.addi r26,r0,0x0
|
l.addi r27,r0,0x0
|
l.addi r27,r0,0x0
|
l.addi r28,r0,0x0
|
l.addi r28,r0,0x0
|
l.addi r29,r0,0x0
|
l.addi r29,r0,0x0
|
l.addi r30,r0,0x0
|
l.addi r30,r0,0x0
|
l.addi r31,r0,0x0
|
l.addi r31,r0,0x0
|
|
|
l.movhi r3,hi(start)
|
l.movhi r3,hi(start)
|
l.ori r3,r3,lo(start)
|
l.ori r3,r3,lo(start)
|
l.jr r3
|
l.jr r3
|
l.nop
|
l.nop
|
start:
|
start:
|
l.jal _init_mc
|
l.jal _init_mc
|
l.nop
|
l.nop
|
|
|
l.movhi r1,hi(_stack)
|
l.movhi r1,hi(_stack)
|
l.ori r1,r1,lo(_stack)
|
l.ori r1,r1,lo(_stack)
|
|
|
/* Setup exception wrappers */
|
/* Setup exception wrappers */
|
l.movhi r3,hi(_src_beg)
|
l.movhi r3,hi(_src_beg)
|
l.ori r3,r3,lo(_src_beg)
|
l.ori r3,r3,lo(_src_beg)
|
l.addi r7,r0,0x100
|
l.addi r7,r0,0x100
|
|
|
1: l.addi r7,r7,0x100
|
1: l.addi r7,r7,0x100
|
l.sfeqi r7,0xf00
|
l.sfeqi r7,0xf00
|
l.bf 1f
|
l.bf 1f
|
l.nop
|
l.nop
|
l.addi r4,r7,0
|
l.addi r4,r7,0
|
l.addi r5,r0,0
|
l.addi r5,r0,0
|
2:
|
2:
|
l.lwz r6,0(r3)
|
l.lwz r6,0(r3)
|
l.sw 0(r4),r6
|
l.sw 0(r4),r6
|
l.addi r3,r3,4
|
l.addi r3,r3,4
|
l.addi r4,r4,4
|
l.addi r4,r4,4
|
l.addi r5,r5,1
|
l.addi r5,r5,1
|
l.sfeqi r5,16
|
l.sfeqi r5,16
|
l.bf 1b
|
l.bf 1b
|
l.nop
|
l.nop
|
l.j 2b
|
l.j 2b
|
l.nop
|
l.nop
|
1:
|
1:
|
/* Copy data section */
|
/* Copy data section */
|
l.movhi r4,hi(_dst_beg)
|
l.movhi r4,hi(_dst_beg)
|
l.ori r4,r4,lo(_dst_beg)
|
l.ori r4,r4,lo(_dst_beg)
|
l.movhi r5,hi(_dst_end)
|
l.movhi r5,hi(_dst_end)
|
l.ori r5,r5,lo(_dst_end)
|
l.ori r5,r5,lo(_dst_end)
|
l.sub r5,r5,r4
|
l.sub r5,r5,r4
|
l.sfeqi r5,0
|
l.sfeqi r5,0
|
l.bf 2f
|
l.bf 2f
|
l.nop
|
l.nop
|
1: l.lwz r6,0(r3)
|
1: l.lwz r6,0(r3)
|
l.sw 0(r4),r6
|
l.sw 0(r4),r6
|
l.addi r3,r3,4
|
l.addi r3,r3,4
|
l.addi r4,r4,4
|
l.addi r4,r4,4
|
l.addi r5,r5,-4
|
l.addi r5,r5,-4
|
l.sfgtsi r5,0
|
l.sfgtsi r5,0
|
l.bf 1b
|
l.bf 1b
|
l.nop
|
l.nop
|
|
|
2:
|
2:
|
|
|
l.movhi r2,hi(reset)
|
l.movhi r2,hi(reset)
|
l.ori r2,r2,lo(reset)
|
l.ori r2,r2,lo(reset)
|
l.jr r2
|
l.jr r2
|
l.nop
|
l.nop
|
|
|
_init_mc:
|
_init_mc:
|
|
|
l.movhi r3,hi(MC_BASE_ADDR)
|
l.movhi r3,hi(MC_BASE_ADDR)
|
l.ori r3,r3,lo(MC_BASE_ADDR)
|
l.ori r3,r3,lo(MC_BASE_ADDR)
|
|
|
l.addi r4,r3,MC_CSC(0)
|
l.addi r4,r3,MC_CSC(0)
|
l.movhi r5,hi(FLASH_BASE_ADDR)
|
l.movhi r5,hi(FLASH_BASE_ADDR)
|
l.srai r5,r5,6
|
l.srai r5,r5,6
|
l.ori r5,r5,0x0025
|
l.ori r5,r5,0x0025
|
l.sw 0(r4),r5
|
l.sw 0(r4),r5
|
|
|
l.addi r4,r3,MC_TMS(0)
|
l.addi r4,r3,MC_TMS(0)
|
l.movhi r5,hi(FLASH_TMS_VAL)
|
l.movhi r5,hi(FLASH_TMS_VAL)
|
l.ori r5,r5,lo(FLASH_TMS_VAL)
|
l.ori r5,r5,lo(FLASH_TMS_VAL)
|
l.sw 0(r4),r5
|
l.sw 0(r4),r5
|
|
|
l.addi r4,r3,MC_BA_MASK
|
l.addi r4,r3,MC_BA_MASK
|
l.addi r5,r0,MC_MASK_VAL
|
l.addi r5,r0,MC_MASK_VAL
|
l.sw 0(r4),r5
|
l.sw 0(r4),r5
|
|
|
l.addi r4,r3,MC_CSR
|
l.addi r4,r3,MC_CSR
|
l.movhi r5,hi(MC_CSR_VAL)
|
l.movhi r5,hi(MC_CSR_VAL)
|
l.ori r5,r5,lo(MC_CSR_VAL)
|
l.ori r5,r5,lo(MC_CSR_VAL)
|
l.sw 0(r4),r5
|
l.sw 0(r4),r5
|
|
|
l.addi r4,r3,MC_TMS(1)
|
l.addi r4,r3,MC_TMS(1)
|
l.movhi r5,hi(SDRAM_TMS_VAL)
|
l.movhi r5,hi(SDRAM_TMS_VAL)
|
l.ori r5,r5,lo(SDRAM_TMS_VAL)
|
l.ori r5,r5,lo(SDRAM_TMS_VAL)
|
l.sw 0(r4),r5
|
l.sw 0(r4),r5
|
|
|
l.addi r4,r3,MC_CSC(1)
|
l.addi r4,r3,MC_CSC(1)
|
l.movhi r5,hi(SDRAM_BASE_ADDR)
|
l.movhi r5,hi(SDRAM_BASE_ADDR)
|
l.srai r5,r5,6
|
l.srai r5,r5,6
|
l.ori r5,r5,0x0411
|
l.ori r5,r5,0x0411
|
l.sw 0(r4),r5
|
l.sw 0(r4),r5
|
|
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
|
|
store_regs:
|
store_regs:
|
l.sw 0x00(r1),r2
|
l.sw 0x00(r1),r2
|
l.sw 0x04(r1),r3
|
l.sw 0x04(r1),r3
|
l.sw 0x08(r1),r4
|
l.sw 0x08(r1),r4
|
l.sw 0x0c(r1),r5
|
l.sw 0x0c(r1),r5
|
l.sw 0x10(r1),r6
|
l.sw 0x10(r1),r6
|
l.sw 0x14(r1),r7
|
l.sw 0x14(r1),r7
|
l.sw 0x18(r1),r8
|
l.sw 0x18(r1),r8
|
l.sw 0x24(r1),r11
|
l.sw 0x24(r1),r11
|
l.sw 0x28(r1),r12
|
l.sw 0x28(r1),r12
|
l.sw 0x2c(r1),r13
|
l.sw 0x2c(r1),r13
|
l.sw 0x30(r1),r14
|
l.sw 0x30(r1),r14
|
l.sw 0x34(r1),r15
|
l.sw 0x34(r1),r15
|
l.sw 0x38(r1),r16
|
l.sw 0x38(r1),r16
|
l.sw 0x3c(r1),r17
|
l.sw 0x3c(r1),r17
|
l.sw 0x40(r1),r18
|
l.sw 0x40(r1),r18
|
l.sw 0x44(r1),r19
|
l.sw 0x44(r1),r19
|
l.sw 0x48(r1),r20
|
l.sw 0x48(r1),r20
|
l.sw 0x4c(r1),r21
|
l.sw 0x4c(r1),r21
|
l.sw 0x50(r1),r22
|
l.sw 0x50(r1),r22
|
l.sw 0x54(r1),r23
|
l.sw 0x54(r1),r23
|
l.sw 0x58(r1),r24
|
l.sw 0x58(r1),r24
|
l.sw 0x5c(r1),r25
|
l.sw 0x5c(r1),r25
|
l.sw 0x60(r1),r26
|
l.sw 0x60(r1),r26
|
l.sw 0x64(r1),r27
|
l.sw 0x64(r1),r27
|
l.sw 0x68(r1),r28
|
l.sw 0x68(r1),r28
|
l.sw 0x6c(r1),r29
|
l.sw 0x6c(r1),r29
|
l.sw 0x70(r1),r30
|
l.sw 0x70(r1),r30
|
l.sw 0x74(r1),r31
|
l.sw 0x74(r1),r31
|
|
|
l.mfspr r3,r0,SPR_EPCR_BASE
|
l.mfspr r3,r0,SPR_EPCR_BASE
|
l.movhi r4,hi(_except_pc)
|
l.movhi r4,hi(_except_pc)
|
l.ori r4,r4,lo(_except_pc)
|
l.ori r4,r4,lo(_except_pc)
|
l.sw 0(r4),r3
|
l.sw 0(r4),r3
|
|
|
l.mfspr r3,r0,SPR_EEAR_BASE
|
l.mfspr r3,r0,SPR_EEAR_BASE
|
l.movhi r4,hi(_except_ea)
|
l.movhi r4,hi(_except_ea)
|
l.ori r4,r4,lo(_except_ea)
|
l.ori r4,r4,lo(_except_ea)
|
l.sw 0(r4),r3
|
l.sw 0(r4),r3
|
|
|
l.movhi r9,hi(end_except)
|
l.movhi r9,hi(end_except)
|
l.ori r9,r9,lo(end_except)
|
l.ori r9,r9,lo(end_except)
|
|
|
l.lwz r10,0(r10)
|
l.lwz r10,0(r10)
|
l.jr r10
|
l.jr r10
|
l.nop
|
l.nop
|
|
|
end_except:
|
end_except:
|
l.lwz r2,0x00(r1)
|
l.lwz r2,0x00(r1)
|
l.lwz r3,0x04(r1)
|
l.lwz r3,0x04(r1)
|
l.lwz r4,0x08(r1)
|
l.lwz r4,0x08(r1)
|
l.lwz r5,0x0c(r1)
|
l.lwz r5,0x0c(r1)
|
l.lwz r6,0x10(r1)
|
l.lwz r6,0x10(r1)
|
l.lwz r7,0x14(r1)
|
l.lwz r7,0x14(r1)
|
l.lwz r8,0x18(r1)
|
l.lwz r8,0x18(r1)
|
l.lwz r9,0x1c(r1)
|
l.lwz r9,0x1c(r1)
|
l.lwz r10,0x20(r1)
|
l.lwz r10,0x20(r1)
|
l.lwz r11,0x24(r1)
|
l.lwz r11,0x24(r1)
|
l.lwz r12,0x28(r1)
|
l.lwz r12,0x28(r1)
|
l.lwz r13,0x2c(r1)
|
l.lwz r13,0x2c(r1)
|
l.lwz r14,0x30(r1)
|
l.lwz r14,0x30(r1)
|
l.lwz r15,0x34(r1)
|
l.lwz r15,0x34(r1)
|
l.lwz r16,0x38(r1)
|
l.lwz r16,0x38(r1)
|
l.lwz r17,0x3c(r1)
|
l.lwz r17,0x3c(r1)
|
l.lwz r18,0x40(r1)
|
l.lwz r18,0x40(r1)
|
l.lwz r19,0x44(r1)
|
l.lwz r19,0x44(r1)
|
l.lwz r20,0x48(r1)
|
l.lwz r20,0x48(r1)
|
l.lwz r21,0x4c(r1)
|
l.lwz r21,0x4c(r1)
|
l.lwz r22,0x50(r1)
|
l.lwz r22,0x50(r1)
|
l.lwz r23,0x54(r1)
|
l.lwz r23,0x54(r1)
|
l.lwz r24,0x58(r1)
|
l.lwz r24,0x58(r1)
|
l.lwz r25,0x5c(r1)
|
l.lwz r25,0x5c(r1)
|
l.lwz r26,0x60(r1)
|
l.lwz r26,0x60(r1)
|
l.lwz r27,0x64(r1)
|
l.lwz r27,0x64(r1)
|
l.lwz r28,0x68(r1)
|
l.lwz r28,0x68(r1)
|
l.lwz r29,0x6c(r1)
|
l.lwz r29,0x6c(r1)
|
l.lwz r30,0x70(r1)
|
l.lwz r30,0x70(r1)
|
l.lwz r31,0x74(r1)
|
l.lwz r31,0x74(r1)
|
l.addi r1,r1,120
|
l.addi r1,r1,120
|
l.mtspr r0,r9,SPR_EPCR_BASE
|
l.mtspr r0,r9,SPR_EPCR_BASE
|
l.rfe
|
l.rfe
|
l.nop
|
l.nop
|
|
|
.section .text
|
.section .text
|
|
|
_except_basic:
|
_except_basic:
|
_sys1:
|
_sys1:
|
l.addi r3,r0,-2 /* Enable exceptiom recognition and external interrupt,set user mode */
|
l.addi r3,r0,-2 /* Enable exceptiom recognition and external interrupt,set user mode */
|
l.mfspr r4,r0,SPR_SR
|
l.mfspr r4,r0,SPR_SR
|
l.and r4,r4,r3
|
l.and r4,r4,r3
|
l.ori r4,r4,(SPR_SR_IEE|SPR_SR_TEE)
|
l.ori r4,r4,(SPR_SR_IEE|SPR_SR_TEE)
|
l.mtspr r0,r4,SPR_SR
|
l.mtspr r0,r4,SPR_SR
|
|
|
l.addi r3,r0,0
|
l.addi r3,r0,0
|
l.sys 1
|
l.sys 1
|
l.addi r3,r3,2
|
l.addi r3,r3,2
|
|
|
_sys2:
|
_sys2:
|
l.addi r11,r0,0
|
l.addi r11,r0,0
|
|
|
l.mfspr r4,r0,SPR_SR /* Check SR */
|
l.mfspr r4,r0,SPR_SR /* Check SR */
|
l.andi r4,r4,(SPR_SR_IEE|SPR_SR_TEE|SPR_SR_SM)
|
l.andi r4,r4,(SPR_SR_IEE|SPR_SR_TEE|SPR_SR_SM)
|
l.sfeqi r4,(SPR_SR_IEE|SPR_SR_TEE|SPR_SR_SM)
|
l.sfeqi r4,(SPR_SR_IEE|SPR_SR_TEE|SPR_SR_SM)
|
l.bf 1f
|
l.bf 1f
|
l.nop
|
l.nop
|
l.addi r11,r11,1
|
l.addi r11,r11,1
|
1:
|
1:
|
l.sfeqi r3,4 /* Check if l.sys or l.rfe has delay slot */
|
l.sfeqi r3,4 /* Check if l.sys or l.rfe has delay slot */
|
l.bf 1f
|
l.bf 1f
|
l.nop
|
l.nop
|
l.addi r11,r11,2
|
l.addi r11,r11,2
|
1:
|
1:
|
l.sfeqi r5,0x1c /* Check the EPCR */
|
l.sfeqi r5,0x1c /* Check the EPCR */
|
l.bf 1f
|
l.bf 1f
|
l.nop
|
l.nop
|
l.addi r11,r11,4
|
l.addi r11,r11,4
|
1:
|
1:
|
l.sfeqi r6,SPR_SR_SM /* Check the SR when exception is taken */
|
l.sfeqi r6,SPR_SR_SM /* Check the SR when exception is taken */
|
l.bf 1f
|
l.bf 1f
|
l.nop
|
l.nop
|
l.addi r11,r11,8
|
l.addi r11,r11,8
|
1:
|
1:
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
|
|
_lo_dmmu_en:
|
_lo_dmmu_en:
|
l.mfspr r3,r0,SPR_SR
|
l.mfspr r3,r0,SPR_SR
|
l.ori r3,r3,SPR_SR_DME
|
l.ori r3,r3,SPR_SR_DME
|
l.mtspr r0,r3,SPR_ESR_BASE
|
l.mtspr r0,r3,SPR_ESR_BASE
|
l.mtspr r0,r9,SPR_EPCR_BASE
|
l.mtspr r0,r9,SPR_EPCR_BASE
|
l.rfe
|
l.rfe
|
l.nop
|
l.nop
|
|
|
_lo_immu_en:
|
_lo_immu_en:
|
l.mfspr r3,r0,SPR_SR
|
l.mfspr r3,r0,SPR_SR
|
l.ori r3,r3,SPR_SR_IME
|
l.ori r3,r3,SPR_SR_IME
|
l.mtspr r0,r3,SPR_ESR_BASE
|
l.mtspr r0,r3,SPR_ESR_BASE
|
l.mtspr r0,r9,SPR_EPCR_BASE
|
l.mtspr r0,r9,SPR_EPCR_BASE
|
l.rfe
|
l.rfe
|
l.nop
|
l.nop
|
|
|
_call:
|
_call:
|
l.addi r11,r0,0
|
l.addi r11,r0,0
|
l.jr r3
|
l.jr r3
|
l.nop
|
l.nop
|
|
|
_call_with_int:
|
_call_with_int:
|
l.mfspr r8,r0,SPR_SR
|
l.mfspr r8,r0,SPR_SR
|
l.ori r8,r8,SPR_SR_TEE
|
l.ori r8,r8,SPR_SR_TEE
|
l.mtspr r0,r8,SPR_ESR_BASE
|
l.mtspr r0,r8,SPR_ESR_BASE
|
l.mtspr r0,r3,SPR_EPCR_BASE
|
l.mtspr r0,r3,SPR_EPCR_BASE
|
l.rfe
|
l.rfe
|
|
|
_load_acc_32:
|
_load_acc_32:
|
l.movhi r11,hi(0x12345678)
|
l.movhi r11,hi(0x12345678)
|
l.ori r11,r11,lo(0x12345678)
|
l.ori r11,r11,lo(0x12345678)
|
l.lwz r11,0(r4)
|
l.lwz r11,0(r4)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
|
|
_load_acc_16:
|
_load_acc_16:
|
l.movhi r11,hi(0x12345678)
|
l.movhi r11,hi(0x12345678)
|
l.ori r11,r11,lo(0x12345678)
|
l.ori r11,r11,lo(0x12345678)
|
l.lhz r11,0(r4)
|
l.lhz r11,0(r4)
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
|
|
_store_acc_32:
|
_store_acc_32:
|
l.movhi r3,hi(0x12345678)
|
l.movhi r3,hi(0x12345678)
|
l.ori r3,r3,lo(0x12345678)
|
l.ori r3,r3,lo(0x12345678)
|
l.sw 0(r4),r3
|
l.sw 0(r4),r3
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
|
|
_store_acc_16:
|
_store_acc_16:
|
l.movhi r3,hi(0x12345678)
|
l.movhi r3,hi(0x12345678)
|
l.ori r3,r3,lo(0x12345678)
|
l.ori r3,r3,lo(0x12345678)
|
l.sh 0(r4),r3
|
l.sh 0(r4),r3
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
|
|
_load_b_acc_32:
|
_load_b_acc_32:
|
l.movhi r11,hi(0x12345678)
|
l.movhi r11,hi(0x12345678)
|
l.ori r11,r11,lo(0x12345678)
|
l.ori r11,r11,lo(0x12345678)
|
l.jr r9
|
l.jr r9
|
l.lwz r11,0(r4)
|
l.lwz r11,0(r4)
|
|
|
_b_trap:
|
_b_trap:
|
l.jr r9
|
l.jr r9
|
_trap:
|
_trap:
|
l.trap 1
|
l.trap 1
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
|
|
_b_range:
|
_b_range:
|
l.jr r9
|
l.jr r9
|
_range:
|
_range:
|
l.addi r3,r0,-1
|
l.addi r3,r0,-1
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
|
|
_int_trigger:
|
_int_trigger:
|
l.addi r11,r0,0
|
l.addi r11,r0,0
|
l.mfspr r3,r0,SPR_SR
|
l.mfspr r3,r0,SPR_SR
|
l.ori r3,r3,SPR_SR_TEE
|
l.ori r3,r3,SPR_SR_TEE
|
l.mtspr r0,r3,SPR_SR
|
l.mtspr r0,r3,SPR_SR
|
l.addi r11,r11,1
|
l.addi r11,r11,1
|
|
|
_int_loop:
|
_int_loop:
|
l.j _int_loop
|
l.j _int_loop
|
l.lwz r5,0(r4);
|
l.lwz r5,0(r4);
|
|
|
_jump_back:
|
_jump_back:
|
l.addi r11,r0,0
|
l.addi r11,r0,0
|
l.jr r9
|
l.jr r9
|
l.addi r11,r11,1
|
l.addi r11,r11,1
|
|
|
|
|