[258] | 1 | /************************************************************************************ |
---|
| 2 | * GIET: Interruption/Exception/Trap Handler for MIPS32 processor |
---|
| 3 | * |
---|
| 4 | * The base address of the segment containing this code MUST be 0x80000000, in |
---|
| 5 | * order to have the entry point at address 0x80000180!!! All messages are |
---|
| 6 | * printed on the TTY corresponding to the task&processor identifiers. |
---|
| 7 | * |
---|
| 8 | * It uses two arrays of functions: |
---|
| 9 | * - the _cause_vector[16] array defines the 16 causes to enter the GIET |
---|
| 10 | * it is initialized in th exc_handler.c file |
---|
[267] | 11 | * - the _syscall_vector[64] array defines the 64 system calls entry points |
---|
[258] | 12 | * it is initialised in the sys_handler.c file |
---|
| 13 | ***********************************************************************************/ |
---|
| 14 | |
---|
| 15 | .section .giet, "ax", @progbits |
---|
| 16 | .space 0x180 |
---|
| 17 | |
---|
| 18 | /* |
---|
| 19 | * GIET Entry point (at address 0x80000180) |
---|
| 20 | */ |
---|
| 21 | |
---|
| 22 | .func _giet |
---|
| 23 | .type _giet, %function |
---|
| 24 | |
---|
| 25 | _giet: |
---|
| 26 | mfc0 $27, $13 /* $27 <= Cause register */ |
---|
| 27 | la $26, _cause_vector /* $26 <= _cause_vector */ |
---|
| 28 | andi $27, $27, 0x3c /* $27 <= XCODE*4 */ |
---|
| 29 | addu $26, $26, $27 /* $26 <= &_cause_vector[XCODE] */ |
---|
| 30 | lw $26, ($26) /* $26 <= _cause_vector[XCODE] */ |
---|
| 31 | jr $26 /* Jump indexed by XCODE */ |
---|
| 32 | |
---|
| 33 | .endfunc |
---|
| 34 | .size _giet, .-_giet |
---|
| 35 | |
---|
| 36 | /* |
---|
| 37 | * *** System Call Handler *** |
---|
| 38 | * |
---|
| 39 | * A system call is handled as a special function call. |
---|
| 40 | * - $2 contains the system call index (< 64). |
---|
| 41 | * - $3 is used to store the syscall address |
---|
| 42 | * - $4, $5, $6, $7 contain the arguments values. |
---|
| 43 | * - The return address (EPC) and the SR are saved in the stack. |
---|
| 44 | * - Interrupts are enabled before branching to the syscall. |
---|
| 45 | * - All syscalls must return to the syscall handler. |
---|
| 46 | * - $2, $3, $4, $5, $6, $7 as well as $26 & $27 can be modified. |
---|
| 47 | * |
---|
| 48 | * In case of undefined system call, an error message displays the value of EPC |
---|
| 49 | * on the TTY corresponding to the processor, and the user program is killed. |
---|
| 50 | */ |
---|
| 51 | |
---|
| 52 | .globl _sys_handler |
---|
| 53 | .func _sys_handler |
---|
| 54 | .type _sys_handler, %function |
---|
| 55 | |
---|
| 56 | _sys_handler: |
---|
| 57 | addiu $29, $29, -24 /* 2 slots for SR&EPC, 4 slots for args passing */ |
---|
| 58 | mfc0 $26, $12 /* load SR */ |
---|
| 59 | sw $26, 16($29) /* save it in the stack */ |
---|
| 60 | mfc0 $27, $14 /* load EPC */ |
---|
| 61 | addiu $27, $27, 4 /* increment EPC for return address */ |
---|
| 62 | sw $27, 20($29) /* save it in the stack */ |
---|
| 63 | |
---|
| 64 | andi $26, $2, 0x3F /* $26 <= syscall index (i < 64) */ |
---|
| 65 | sll $26, $26, 2 /* $26 <= index * 4 */ |
---|
| 66 | la $27, _syscall_vector /* $27 <= &_syscall_vector[0] */ |
---|
| 67 | addu $27, $27, $26 /* $27 <= &_syscall_vector[i] */ |
---|
| 68 | lw $3, 0($27) /* $3 <= syscall address */ |
---|
| 69 | |
---|
| 70 | li $27, 0xFFFFFFED /* Mask for UM & EXL bits */ |
---|
| 71 | mfc0 $26, $12 /* $26 <= SR */ |
---|
| 72 | and $26, $26, $27 /* UM = 0 / EXL = 0 */ |
---|
| 73 | mtc0 $26, $12 /* interrupt enabled */ |
---|
| 74 | jalr $3 /* jump to the proper syscall */ |
---|
| 75 | mtc0 $0, $12 /* interrupt disbled */ |
---|
| 76 | |
---|
| 77 | lw $26, 16($29) /* load SR from stack */ |
---|
| 78 | mtc0 $26, $12 /* restore SR */ |
---|
| 79 | lw $26, 20($29) /* load EPC from stack */ |
---|
| 80 | mtc0 $26, $14 /* restore EPC */ |
---|
| 81 | addiu $29, $29, 24 /* restore stack pointer */ |
---|
| 82 | eret /* exit GIET */ |
---|
| 83 | |
---|
| 84 | .endfunc |
---|
| 85 | .size _sys_handler, .-_sys_handler |
---|
| 86 | |
---|
| 87 | /* |
---|
| 88 | * *** Interrupt Handler *** |
---|
| 89 | * |
---|
| 90 | * This simple interrupt handler cannot be interrupted. |
---|
| 91 | * |
---|
| 92 | * All non persistant registers, such as $1 to $15, and $24 to $25, as well as |
---|
| 93 | * register $31 and EPC, are saved in the interrupted program stack, before |
---|
| 94 | * calling the Interrupt Service Routine. These registers can be used by the |
---|
| 95 | * ISR code. |
---|
| 96 | */ |
---|
| 97 | |
---|
| 98 | .globl _int_handler |
---|
| 99 | .func _int_handler |
---|
| 100 | .type _int_handler, %function |
---|
| 101 | |
---|
| 102 | _int_handler: |
---|
| 103 | addiu $29, $29, -25*4 /* stack space reservation (21 registers to |
---|
| 104 | save and 4 free words to call function) */ |
---|
| 105 | .set noat |
---|
| 106 | sw $1, 4*4($29) /* save $1 */ |
---|
| 107 | .set at |
---|
| 108 | sw $2, 5*4($29) /* save $2 */ |
---|
| 109 | sw $3, 6*4($29) /* save $3 */ |
---|
| 110 | sw $4, 7*4($29) /* save $4 */ |
---|
| 111 | sw $5, 8*4($29) /* save $5 */ |
---|
| 112 | sw $6, 9*4($29) /* save $6 */ |
---|
| 113 | sw $7, 10*4($29) /* save $7 */ |
---|
| 114 | sw $8, 11*4($29) /* save $8 */ |
---|
| 115 | sw $9, 12*4($29) /* save $9 */ |
---|
| 116 | sw $10, 13*4($29) /* save $10 */ |
---|
| 117 | sw $11, 14*4($29) /* save $11 */ |
---|
| 118 | sw $12, 15*4($29) /* save $12 */ |
---|
| 119 | sw $13, 16*4($29) /* save $13 */ |
---|
| 120 | sw $14, 17*4($29) /* save $14 */ |
---|
| 121 | sw $15, 18*4($29) /* save $15 */ |
---|
| 122 | sw $24, 19*4($29) /* save $24 */ |
---|
| 123 | sw $25, 20*4($29) /* save $25 */ |
---|
| 124 | sw $31, 21*4($29) /* save $31 */ |
---|
| 125 | mflo $26 |
---|
| 126 | sw $26, 22*4($29) /* save LO */ |
---|
| 127 | mfhi $26 |
---|
| 128 | sw $26, 23*4($29) /* save HI */ |
---|
| 129 | mfc0 $27, $14 |
---|
| 130 | sw $27, 24*4($29) /* save EPC */ |
---|
| 131 | |
---|
| 132 | la $26, _irq_demux |
---|
| 133 | jalr $26 /* jump to a C function to find the proper ISR */ |
---|
| 134 | |
---|
| 135 | restore: |
---|
| 136 | .set noat |
---|
| 137 | lw $1, 4*4($29) /* restore $1 */ |
---|
| 138 | .set at |
---|
| 139 | lw $2, 4*5($29) /* restore $2 */ |
---|
| 140 | lw $3, 4*6($29) /* restore $3 */ |
---|
| 141 | lw $4, 4*7($29) /* restore $4 */ |
---|
| 142 | lw $5, 4*8($29) /* restore $5 */ |
---|
| 143 | lw $6, 4*9($29) /* restore $6 */ |
---|
| 144 | lw $7, 4*10($29) /* restore $7 */ |
---|
| 145 | lw $8, 4*11($29) /* restore $8 */ |
---|
| 146 | lw $9, 4*12($29) /* restore $9 */ |
---|
| 147 | lw $10, 4*13($29) /* restore $10 */ |
---|
| 148 | lw $11, 4*14($29) /* restore $11 */ |
---|
| 149 | lw $12, 4*15($29) /* restore $12 */ |
---|
| 150 | lw $13, 4*16($29) /* restore $13 */ |
---|
| 151 | lw $14, 4*17($29) /* restore $14 */ |
---|
| 152 | lw $15, 4*18($29) /* restore $15 */ |
---|
| 153 | lw $24, 4*19($29) /* restore $24 */ |
---|
| 154 | lw $25, 4*20($29) /* restore $25 */ |
---|
| 155 | lw $31, 4*21($29) /* restore $31 */ |
---|
| 156 | lw $26, 4*22($29) |
---|
| 157 | mtlo $26 /* restore LO */ |
---|
| 158 | lw $26, 4*23($29) |
---|
| 159 | mthi $26 /* restore HI */ |
---|
| 160 | lw $27, 4*24($29) /* return address (EPC) */ |
---|
| 161 | addiu $29, $29, 25*4 /* restore stack pointer */ |
---|
| 162 | mtc0 $27, $14 /* restore EPC */ |
---|
| 163 | eret /* exit GIET */ |
---|
| 164 | |
---|
| 165 | .endfunc |
---|
| 166 | .size _int_handler, .-_int_handler |
---|
| 167 | |
---|