138 lines
3.4 KiB
ArmAsm
138 lines
3.4 KiB
ArmAsm
|
/*
|
||
|
|
* Copyright (c) 2006-2018, RT-Thread Development Team
|
||
|
|
*
|
||
|
|
* SPDX-License-Identifier: Apache-2.0
|
||
|
|
*
|
||
|
|
* Change Logs:
|
||
|
|
* Date Author Notes
|
||
|
|
* 2018/10/02 Bernard The first version
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "cpuport.h"
|
||
|
|
|
||
|
|
.section .text.entry
|
||
|
|
.align 2
|
||
|
|
.global trap_entry
|
||
|
|
trap_entry:
|
||
|
|
|
||
|
|
/* save thread context to thread stack */
|
||
|
|
addi sp, sp, -32 * REGBYTES
|
||
|
|
|
||
|
|
STORE x1, 1 * REGBYTES(sp)
|
||
|
|
li t0, 0x80
|
||
|
|
STORE t0, 2 * REGBYTES(sp)
|
||
|
|
|
||
|
|
STORE x4, 4 * REGBYTES(sp)
|
||
|
|
STORE x5, 5 * 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)
|
||
|
|
|
||
|
|
/* switch to interrupt stack */
|
||
|
|
move s0, sp
|
||
|
|
|
||
|
|
/* get cpu id */
|
||
|
|
csrr t0, mhartid
|
||
|
|
|
||
|
|
/* switch interrupt stack of current cpu */
|
||
|
|
la sp, __stack_start__
|
||
|
|
addi t1, t0, 1
|
||
|
|
li t2, __STACKSIZE__
|
||
|
|
mul t1, t1, t2
|
||
|
|
add sp, sp, t1 /* sp = (cpuid + 1) * __STACKSIZE__ + __stack_start__ */
|
||
|
|
|
||
|
|
/* handle interrupt */
|
||
|
|
call rt_interrupt_enter
|
||
|
|
csrr a0, mcause
|
||
|
|
csrr a1, mepc
|
||
|
|
mv a2, sp
|
||
|
|
call handle_trap
|
||
|
|
call rt_interrupt_leave
|
||
|
|
|
||
|
|
/* switch to from_thread stack */
|
||
|
|
move sp, s0
|
||
|
|
|
||
|
|
/* need to switch new thread */
|
||
|
|
la s0, rt_thread_switch_interrupt_flag
|
||
|
|
lw s2, 0(s0)
|
||
|
|
beqz s2, spurious_interrupt
|
||
|
|
sw zero, 0(s0)
|
||
|
|
|
||
|
|
csrr a0, mepc
|
||
|
|
STORE a0, 0 * REGBYTES(sp)
|
||
|
|
|
||
|
|
la s0, rt_interrupt_from_thread
|
||
|
|
LOAD s1, 0(s0)
|
||
|
|
STORE sp, 0(s1)
|
||
|
|
|
||
|
|
la s0, rt_interrupt_to_thread
|
||
|
|
LOAD s1, 0(s0)
|
||
|
|
LOAD sp, 0(s1)
|
||
|
|
|
||
|
|
LOAD a0, 0 * REGBYTES(sp)
|
||
|
|
csrw mepc, a0
|
||
|
|
|
||
|
|
spurious_interrupt:
|
||
|
|
LOAD x1, 1 * REGBYTES(sp)
|
||
|
|
|
||
|
|
/* Remain in M-mode after mret */
|
||
|
|
li t0, 0x00001800
|
||
|
|
csrs mstatus, t0
|
||
|
|
LOAD t0, 2 * REGBYTES(sp)
|
||
|
|
csrs mstatus, t0
|
||
|
|
|
||
|
|
LOAD x4, 4 * REGBYTES(sp)
|
||
|
|
LOAD x5, 5 * REGBYTES(sp)
|
||
|
|
LOAD x6, 6 * REGBYTES(sp)
|
||
|
|
LOAD x7, 7 * REGBYTES(sp)
|
||
|
|
LOAD x8, 8 * REGBYTES(sp)
|
||
|
|
LOAD x9, 9 * REGBYTES(sp)
|
||
|
|
LOAD x10, 10 * REGBYTES(sp)
|
||
|
|
LOAD x11, 11 * REGBYTES(sp)
|
||
|
|
LOAD x12, 12 * REGBYTES(sp)
|
||
|
|
LOAD x13, 13 * REGBYTES(sp)
|
||
|
|
LOAD x14, 14 * REGBYTES(sp)
|
||
|
|
LOAD x15, 15 * REGBYTES(sp)
|
||
|
|
LOAD x16, 16 * REGBYTES(sp)
|
||
|
|
LOAD x17, 17 * REGBYTES(sp)
|
||
|
|
LOAD x18, 18 * REGBYTES(sp)
|
||
|
|
LOAD x19, 19 * REGBYTES(sp)
|
||
|
|
LOAD x20, 20 * REGBYTES(sp)
|
||
|
|
LOAD x21, 21 * REGBYTES(sp)
|
||
|
|
LOAD x22, 22 * REGBYTES(sp)
|
||
|
|
LOAD x23, 23 * REGBYTES(sp)
|
||
|
|
LOAD x24, 24 * REGBYTES(sp)
|
||
|
|
LOAD x25, 25 * REGBYTES(sp)
|
||
|
|
LOAD x26, 26 * REGBYTES(sp)
|
||
|
|
LOAD x27, 27 * REGBYTES(sp)
|
||
|
|
LOAD x28, 28 * REGBYTES(sp)
|
||
|
|
LOAD x29, 29 * REGBYTES(sp)
|
||
|
|
LOAD x30, 30 * REGBYTES(sp)
|
||
|
|
LOAD x31, 31 * REGBYTES(sp)
|
||
|
|
|
||
|
|
addi sp, sp, 32 * REGBYTES
|
||
|
|
mret
|