#include "spr_defs.h"
|
#include "spr_defs.h"
|
|
|
// Linked from 0x200, so subtract 0x200 from each .org
|
// Linked from 0x200, so subtract 0x200 from each .org
|
.section .vectors, "ax"
|
.section .vectors, "ax"
|
|
|
/*
|
/*
|
.org 0x100
|
.org 0x100
|
|
|
_reset:
|
_reset:
|
l.nop
|
l.nop
|
l.j _reset_except
|
l.j _reset_except
|
l.nop
|
l.nop
|
*/
|
*/
|
.org 0x000
|
|
|
|
_except_200:
|
/* This cannot be a regular function because it would waste the return register r9 of the interrupted procedure. */
|
l.nop
|
/* Furthermore, if this would be a function and l.j handler would be outside of this, the return register set here would be use upon return of this function. */
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
/* However, the desired behavior is to finish the handler and let the return of the service routine simply restore the registers and return to the interrupted procedure. */
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
#define intr_handler(handler) \
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
l.nop ;\
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
l.addi r1,r1,-244 /*free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)*/;\
|
|
/*plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading) */;\
|
|
l.sw 0x18(r1),r9 /*save register r9(return addr) to stack*/;\
|
|
l.jal store_regs /*save registers r3-r31 (except r9) to stack (r9 is changed here)*/;\
|
|
l.nop ;\
|
|
;\
|
|
l.movhi r9,hi(end_except) /*set return addr to end_except instruction*/;\
|
|
l.ori r9,r9,lo(end_except)/*set return addr to end_except instruction*/;\
|
|
l.j handler ;\
|
l.nop
|
l.nop
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
.org 0x000
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
_except_200:
|
l.j buserr_except
|
intr_handler(buserr_except)
|
l.nop
|
|
|
|
.org 0x100
|
.org 0x100
|
|
|
_except_300:
|
_except_300:
|
l.nop
|
intr_handler(dpf_except)
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
|
l.nop
|
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
|
l.j dpf_except
|
|
l.nop
|
|
|
|
.org 0x200
|
.org 0x200
|
|
|
_except_400:
|
_except_400:
|
l.nop
|
intr_handler(ipf_except)
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
|
l.nop
|
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
|
l.j ipf_except
|
|
l.nop
|
|
|
|
.org 0x300
|
.org 0x300
|
|
|
_except_500:
|
_except_500:
|
l.nop
|
intr_handler(tick_except)
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
|
l.nop
|
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
|
l.j tick_except
|
|
l.nop
|
|
|
|
.org 0x400
|
.org 0x400
|
|
|
_except_600:
|
_except_600:
|
l.nop
|
intr_handler(align_except)
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
|
l.nop
|
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
|
l.j align_except
|
|
l.nop
|
|
|
|
.org 0x500
|
.org 0x500
|
|
|
_except_700:
|
_except_700:
|
l.nop
|
intr_handler(illegal_except)
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
|
l.nop
|
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
|
l.j illegal_except
|
|
l.nop
|
|
|
|
.org 0x600
|
.org 0x600
|
|
|
_except_800:
|
_except_800:
|
l.nop
|
intr_handler(ext_except)
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
|
l.nop
|
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
|
l.j ext_except //jmp to C interrupt handler (returns later to end_except)
|
|
l.nop
|
|
|
|
|
|
.org 0x700
|
.org 0x700
|
|
|
_except_900:
|
_except_900:
|
l.nop
|
intr_handler(dtlbmiss_except)
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
|
l.nop
|
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
|
l.j dtlbmiss_except
|
|
l.nop
|
|
|
|
.org 0x800
|
.org 0x800
|
|
|
_except_a00:
|
_except_a00:
|
l.nop
|
intr_handler(itlbmiss_except)
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
|
l.nop
|
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
|
l.j itlbmiss_except
|
|
l.nop
|
|
|
|
.org 0x900
|
.org 0x900
|
|
|
_except_b00:
|
_except_b00:
|
l.nop
|
intr_handler(range_except)
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
|
l.nop
|
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
|
l.j range_except
|
|
l.nop
|
|
|
|
.org 0xa00
|
.org 0xa00
|
|
|
_except_c00:
|
_except_c00:
|
l.nop
|
intr_handler(syscall_except)
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
|
l.nop
|
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
|
l.j syscall_except
|
|
l.nop
|
|
|
|
.org 0xb00
|
.org 0xb00
|
|
|
_except_d00:
|
_except_d00:
|
l.nop
|
intr_handler(res1_except)
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
|
l.nop
|
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
|
l.j res1_except
|
|
l.nop
|
|
|
|
.org 0xc00
|
.org 0xc00
|
|
|
_except_e00:
|
_except_e00:
|
l.nop
|
intr_handler(trap_except)
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
|
l.nop
|
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
|
l.j trap_except
|
|
l.nop
|
|
|
|
.org 0xd00
|
.org 0xd00
|
|
|
_except_f00:
|
_except_f00:
|
l.nop
|
intr_handler(res2_except)
|
l.addi r1,r1,-244 //free 29 words (29 x 4 = 112) + 4 because stack points to contained data (stack is r1)
|
|
//plus 128 bytes not to mess with the previous frame pointer (32 register x 4 bytes = 128 bytes ) (required by C++ multiple threading)
|
|
l.sw 0x18(r1),r9 //save register r9(return addr) to stack
|
|
l.jal store_regs //save registers r3-r31 (except r9) to stack (r9 is changed here)
|
|
l.nop
|
|
|
|
l.movhi r9,hi(end_except) //set return addr to end_except instruction
|
|
l.ori r9,r9,lo(end_except) //set return addr to end_except instruction
|
|
l.j res2_except
|
|
l.nop
|
|
|
|
store_regs: //save registers r3-r31 (except r9) to stack
|
store_regs: //save registers r3-r31 (except r9) to stack
|
l.sw 0x00(r1),r3
|
l.sw 0x00(r1),r3
|
l.sw 0x04(r1),r4
|
l.sw 0x04(r1),r4
|
l.sw 0x08(r1),r5
|
l.sw 0x08(r1),r5
|
l.sw 0x0c(r1),r6
|
l.sw 0x0c(r1),r6
|
l.sw 0x10(r1),r7
|
l.sw 0x10(r1),r7
|
l.sw 0x14(r1),r8
|
l.sw 0x14(r1),r8
|
l.sw 0x1c(r1),r10
|
l.sw 0x1c(r1),r10
|
l.sw 0x20(r1),r11
|
l.sw 0x20(r1),r11
|
l.sw 0x24(r1),r12
|
l.sw 0x24(r1),r12
|
l.sw 0x28(r1),r13
|
l.sw 0x28(r1),r13
|
l.sw 0x2c(r1),r14
|
l.sw 0x2c(r1),r14
|
l.sw 0x30(r1),r15
|
l.sw 0x30(r1),r15
|
l.sw 0x34(r1),r16
|
l.sw 0x34(r1),r16
|
l.sw 0x38(r1),r17
|
l.sw 0x38(r1),r17
|
l.sw 0x3c(r1),r18
|
l.sw 0x3c(r1),r18
|
l.sw 0x40(r1),r19
|
l.sw 0x40(r1),r19
|
l.sw 0x44(r1),r20
|
l.sw 0x44(r1),r20
|
l.sw 0x48(r1),r21
|
l.sw 0x48(r1),r21
|
l.sw 0x4c(r1),r22
|
l.sw 0x4c(r1),r22
|
l.sw 0x50(r1),r23
|
l.sw 0x50(r1),r23
|
l.sw 0x54(r1),r24
|
l.sw 0x54(r1),r24
|
l.sw 0x58(r1),r25
|
l.sw 0x58(r1),r25
|
l.sw 0x5c(r1),r26
|
l.sw 0x5c(r1),r26
|
l.sw 0x60(r1),r27
|
l.sw 0x60(r1),r27
|
l.sw 0x64(r1),r28
|
l.sw 0x64(r1),r28
|
l.sw 0x68(r1),r29
|
l.sw 0x68(r1),r29
|
l.sw 0x6c(r1),r30
|
l.sw 0x6c(r1),r30
|
l.sw 0x70(r1),r31
|
l.sw 0x70(r1),r31
|
l.jr r9
|
l.jr r9
|
l.nop
|
l.nop
|
|
|
end_except: //load back registers from stack r3-r31
|
end_except: //load back registers from stack r3-r31
|
l.lwz r3,0x00(r1)
|
l.lwz r3,0x00(r1)
|
l.lwz r4,0x04(r1)
|
l.lwz r4,0x04(r1)
|
l.lwz r5,0x08(r1)
|
l.lwz r5,0x08(r1)
|
l.lwz r6,0x0c(r1)
|
l.lwz r6,0x0c(r1)
|
l.lwz r7,0x10(r1)
|
l.lwz r7,0x10(r1)
|
l.lwz r8,0x14(r1)
|
l.lwz r8,0x14(r1)
|
l.lwz r9,0x18(r1)
|
l.lwz r9,0x18(r1)
|
l.lwz r10,0x1c(r1)
|
l.lwz r10,0x1c(r1)
|
l.lwz r11,0x20(r1)
|
l.lwz r11,0x20(r1)
|
l.lwz r12,0x24(r1)
|
l.lwz r12,0x24(r1)
|
l.lwz r13,0x28(r1)
|
l.lwz r13,0x28(r1)
|
l.lwz r14,0x2c(r1)
|
l.lwz r14,0x2c(r1)
|
l.lwz r15,0x30(r1)
|
l.lwz r15,0x30(r1)
|
l.lwz r16,0x34(r1)
|
l.lwz r16,0x34(r1)
|
l.lwz r17,0x38(r1)
|
l.lwz r17,0x38(r1)
|
l.lwz r18,0x3c(r1)
|
l.lwz r18,0x3c(r1)
|
l.lwz r19,0x40(r1)
|
l.lwz r19,0x40(r1)
|
l.lwz r20,0x44(r1)
|
l.lwz r20,0x44(r1)
|
l.lwz r21,0x48(r1)
|
l.lwz r21,0x48(r1)
|
l.lwz r22,0x4c(r1)
|
l.lwz r22,0x4c(r1)
|
l.lwz r23,0x50(r1)
|
l.lwz r23,0x50(r1)
|
l.lwz r24,0x54(r1)
|
l.lwz r24,0x54(r1)
|
l.lwz r25,0x58(r1)
|
l.lwz r25,0x58(r1)
|
l.lwz r26,0x5c(r1)
|
l.lwz r26,0x5c(r1)
|
l.lwz r27,0x60(r1)
|
l.lwz r27,0x60(r1)
|
l.lwz r28,0x64(r1)
|
l.lwz r28,0x64(r1)
|
l.lwz r29,0x68(r1)
|
l.lwz r29,0x68(r1)
|
l.lwz r30,0x6c(r1)
|
l.lwz r30,0x6c(r1)
|
l.lwz r31,0x70(r1)
|
l.lwz r31,0x70(r1)
|
l.addi r1,r1,244 //free stack places
|
l.addi r1,r1,244 //free stack places
|
l.rfe //recover SR register and prior PC (jumps back to program)
|
l.rfe //recover SR register and prior PC (jumps back to program)
|
l.nop
|
l.nop
|
|
|
|
|
