forked from xuos/xiuos
115 lines
3.0 KiB
ArmAsm
115 lines
3.0 KiB
ArmAsm
#include "cpuport.h"
|
|
|
|
.global SW_handler
|
|
.align 2
|
|
SW_handler:
|
|
/* save all from thread context */
|
|
#ifdef ARCH_RISCV_FPU
|
|
addi sp, sp, -32 * FREGBYTES
|
|
FSTORE f0, 0 * FREGBYTES(sp)
|
|
FSTORE f1, 1 * FREGBYTES(sp)
|
|
FSTORE f2, 2 * FREGBYTES(sp)
|
|
FSTORE f3, 3 * FREGBYTES(sp)
|
|
FSTORE f4, 4 * FREGBYTES(sp)
|
|
FSTORE f5, 5 * FREGBYTES(sp)
|
|
FSTORE f6, 6 * FREGBYTES(sp)
|
|
FSTORE f7, 7 * FREGBYTES(sp)
|
|
FSTORE f8, 8 * FREGBYTES(sp)
|
|
FSTORE f9, 9 * FREGBYTES(sp)
|
|
FSTORE f10, 10 * FREGBYTES(sp)
|
|
FSTORE f11, 11 * FREGBYTES(sp)
|
|
FSTORE f12, 12 * FREGBYTES(sp)
|
|
FSTORE f13, 13 * FREGBYTES(sp)
|
|
FSTORE f14, 14 * FREGBYTES(sp)
|
|
FSTORE f15, 15 * FREGBYTES(sp)
|
|
FSTORE f16, 16 * FREGBYTES(sp)
|
|
FSTORE f17, 17 * FREGBYTES(sp)
|
|
FSTORE f18, 18 * FREGBYTES(sp)
|
|
FSTORE f19, 19 * FREGBYTES(sp)
|
|
FSTORE f20, 20 * FREGBYTES(sp)
|
|
FSTORE f21, 21 * FREGBYTES(sp)
|
|
FSTORE f22, 22 * FREGBYTES(sp)
|
|
FSTORE f23, 23 * FREGBYTES(sp)
|
|
FSTORE f24, 24 * FREGBYTES(sp)
|
|
FSTORE f25, 25 * FREGBYTES(sp)
|
|
FSTORE f26, 26 * FREGBYTES(sp)
|
|
FSTORE f27, 27 * FREGBYTES(sp)
|
|
FSTORE f28, 28 * FREGBYTES(sp)
|
|
FSTORE f29, 29 * FREGBYTES(sp)
|
|
FSTORE f30, 30 * FREGBYTES(sp)
|
|
FSTORE f31, 31 * FREGBYTES(sp)
|
|
#endif
|
|
|
|
addi sp, sp, -32 * REGBYTES
|
|
STORE x5, 5 * REGBYTES(sp)
|
|
|
|
/* saved MPIE */
|
|
li t0, 0x80
|
|
STORE t0, 2 * REGBYTES(sp)
|
|
|
|
/* Temporarily disable HPE */
|
|
li t0, 0x20
|
|
csrs 0x804, t0
|
|
|
|
STORE x1, 1 * REGBYTES(sp)
|
|
STORE x4, 4 * REGBYTES(sp)
|
|
STORE x6, 6 * REGBYTES(sp)
|
|
STORE x7, 7 * REGBYTES(sp)
|
|
STORE x8, 8 * REGBYTES(sp)
|
|
STORE x9, 9 * REGBYTES(sp)
|
|
STORE x10, 10 * REGBYTES(sp)
|
|
STORE x11, 11 * REGBYTES(sp)
|
|
STORE x12, 12 * REGBYTES(sp)
|
|
STORE x13, 13 * REGBYTES(sp)
|
|
STORE x14, 14 * REGBYTES(sp)
|
|
STORE x15, 15 * REGBYTES(sp)
|
|
STORE x16, 16 * REGBYTES(sp)
|
|
STORE x17, 17 * REGBYTES(sp)
|
|
STORE x18, 18 * REGBYTES(sp)
|
|
STORE x19, 19 * REGBYTES(sp)
|
|
STORE x20, 20 * REGBYTES(sp)
|
|
STORE x21, 21 * REGBYTES(sp)
|
|
STORE x22, 22 * REGBYTES(sp)
|
|
STORE x23, 23 * REGBYTES(sp)
|
|
STORE x24, 24 * REGBYTES(sp)
|
|
STORE x25, 25 * REGBYTES(sp)
|
|
STORE x26, 26 * REGBYTES(sp)
|
|
STORE x27, 27 * REGBYTES(sp)
|
|
STORE x28, 28 * REGBYTES(sp)
|
|
STORE x29, 29 * REGBYTES(sp)
|
|
STORE x30, 30 * REGBYTES(sp)
|
|
STORE x31, 31 * REGBYTES(sp)
|
|
|
|
csrr a0, mepc
|
|
STORE a0, 0 * REGBYTES(sp)
|
|
|
|
/* switch to interrupt stack */
|
|
csrrw sp,mscratch,sp
|
|
/* clear interrupt */
|
|
jal sw_clearpend
|
|
/* switch to from thread stack */
|
|
csrrw sp,mscratch,sp
|
|
|
|
csrr a0, mepc
|
|
STORE a0, 0 * REGBYTES(sp)
|
|
|
|
la s0, interrupt_from_sp
|
|
LOAD s1, 0(s0)
|
|
STORE sp, 0(s1)
|
|
|
|
la s0, interrupt_to_sp
|
|
LOAD s1, 0(s0)
|
|
LOAD sp, 0(s1)
|
|
|
|
|
|
LOAD a0, 0 * REGBYTES(sp)
|
|
csrw mepc, a0
|
|
|
|
LOAD x1, 1 * REGBYTES(sp)
|
|
|
|
li t0,0x7800
|
|
csrs mstatus, t0
|
|
LOAD t0, 2*REGBYTES(sp)
|
|
csrs mstatus, t0
|
|
|
|
j SwitchKTaskContextExit |