mirror of
https://github.com/fergalmoran/ladybird.git
synced 2026-03-24 22:35:21 +00:00
c7802cef25
When we execute in userspace, the exception level is EL0, so to handle exceptions, such as interrupts, and syscalls, we need to add handlers to vector_table.S. For now we only support running userspace applications in AArch64 mode, so this commit only adds the handlers for that mode.
218 lines
5.2 KiB
ArmAsm
218 lines
5.2 KiB
ArmAsm
/*
|
|
* Copyright (c) 2021, Jesse Buhagiar <jooster669@gmail.com>
|
|
*
|
|
* SPDX-License-Identifier: BSD-2-Clause
|
|
*/
|
|
|
|
.section .text.vector_table
|
|
|
|
#define REGISTER_STATE_SIZE 272
|
|
#define SPSR_EL1_SLOT (31 * 8)
|
|
#define ELR_EL1_SLOT (32 * 8)
|
|
#define TPIDR_EL0_SLOT (33 * 8)
|
|
#define SP_EL0_SLOT (34 * 8)
|
|
|
|
// Vector Table Entry macro. Each entry is aligned at 128 bytes, meaning we have
|
|
// at most that many instructions.
|
|
.macro table_entry label
|
|
.align 7
|
|
b \label
|
|
.endm
|
|
|
|
.macro unimplemented_entry
|
|
.align 7
|
|
wfe
|
|
b .
|
|
.endm
|
|
|
|
.extern exception_common
|
|
.extern handle_interrupt
|
|
|
|
//
|
|
// Save all register states to the current stack
|
|
// and enter the C++ exception handler
|
|
//
|
|
.macro save_current_context
|
|
// Allocate stack space for Trap Frame
|
|
sub sp, sp, #REGISTER_STATE_SIZE
|
|
|
|
stp x0, x1, [sp, #(0 * 0)]
|
|
stp x2, x3, [sp, #(2 * 8)]
|
|
stp x4, x5, [sp, #(4 * 8)]
|
|
stp x6, x7, [sp, #(6 * 8)]
|
|
stp x8, x9, [sp, #(8 * 8)]
|
|
stp x10, x11, [sp, #(10 * 8)]
|
|
stp x12, x13, [sp, #(12 * 8)]
|
|
stp x14, x15, [sp, #(14 * 8)]
|
|
stp x16, x17, [sp, #(16 * 8)]
|
|
stp x18, x19, [sp, #(18 * 8)]
|
|
stp x20, x21, [sp, #(20 * 8)]
|
|
stp x22, x23, [sp, #(22 * 8)]
|
|
stp x24, x25, [sp, #(24 * 8)]
|
|
stp x26, x27, [sp, #(26 * 8)]
|
|
stp x28, x29, [sp, #(28 * 8)]
|
|
str x30, [sp, #(30 * 8)]
|
|
|
|
// Let's save some special registers
|
|
mrs x0, spsr_el1
|
|
str x0, [sp, #SPSR_EL1_SLOT]
|
|
mrs x0, elr_el1
|
|
str x0, [sp, #ELR_EL1_SLOT]
|
|
mrs x0, tpidr_el0
|
|
str x0, [sp, #TPIDR_EL0_SLOT]
|
|
mrs x0, sp_el0
|
|
str x0, [sp, #SP_EL0_SLOT]
|
|
|
|
// Set up TrapFrame struct on the stack
|
|
mov x0, sp
|
|
sub sp, sp, #16
|
|
str x0, [sp, #(1 * 8)]
|
|
str xzr, [sp, #(0 * 0)]
|
|
|
|
// Move stack pointer into first argument register
|
|
// and jump to the C++ exception handler
|
|
mov x0, sp
|
|
.endm
|
|
|
|
.macro restore_previous_context
|
|
// Remove TrapFrame from the stack
|
|
add sp, sp, #16
|
|
|
|
// Restore special registers first
|
|
ldr x0, [sp, #SPSR_EL1_SLOT]
|
|
msr spsr_el1, x0
|
|
ldr x0, [sp, #ELR_EL1_SLOT]
|
|
msr elr_el1, x0
|
|
ldr x0, [sp, #TPIDR_EL0_SLOT]
|
|
msr tpidr_el0, x0
|
|
ldr x0, [sp, #SP_EL0_SLOT]
|
|
msr sp_el0, x0
|
|
|
|
ldp x0, x1, [sp, #(0 * 0)]
|
|
ldp x2, x3, [sp, #(2 * 8)]
|
|
ldp x4, x5, [sp, #(4 * 8)]
|
|
ldp x6, x7, [sp, #(6 * 8)]
|
|
ldp x8, x9, [sp, #(8 * 8)]
|
|
ldp x10, x11, [sp, #(10 * 8)]
|
|
ldp x12, x13, [sp, #(12 * 8)]
|
|
ldp x14, x15, [sp, #(14 * 8)]
|
|
ldp x16, x17, [sp, #(16 * 8)]
|
|
ldp x18, x19, [sp, #(18 * 8)]
|
|
ldp x20, x21, [sp, #(20 * 8)]
|
|
ldp x22, x23, [sp, #(22 * 8)]
|
|
ldp x24, x25, [sp, #(24 * 8)]
|
|
ldp x26, x27, [sp, #(26 * 8)]
|
|
ldp x28, x29, [sp, #(28 * 8)]
|
|
ldr x30, [sp, #(30 * 8)]
|
|
|
|
add sp, sp, #REGISTER_STATE_SIZE
|
|
.endm
|
|
|
|
.global vector_table_el1
|
|
.weak vector_table_el1 // Vector table is weak in case someone wants to hook us in C++ land :^)
|
|
.type vector_table_el1, @object
|
|
|
|
// Vector table is 2KiB aligned (2^11)
|
|
.align 11
|
|
vector_table_el1:
|
|
// Exceptions taken from Current EL, with SP_EL0
|
|
table_entry synchronous_current_elsp_el0
|
|
table_entry irq_current_elsp_el0
|
|
table_entry fiq_current_elsp_el0
|
|
table_entry system_error_current_elsp_el0
|
|
|
|
// Exceptions taken from Current EL, with SP_ELx, x>0
|
|
table_entry synchronous_current_elsp_elx
|
|
table_entry irq_current_elsp_elx
|
|
table_entry fiq_current_elsp_elx
|
|
table_entry system_error_current_elsp_elx
|
|
|
|
// Exceptions from Lower EL, where causing application is in AArch64 mode
|
|
table_entry synchronous_lower_el
|
|
table_entry irq_lower_el
|
|
table_entry fiq_lower_el
|
|
table_entry system_error_lower_el
|
|
|
|
// Exceptions from Lower EL, where causing application is in AArch32 mode
|
|
unimplemented_entry
|
|
unimplemented_entry
|
|
unimplemented_entry
|
|
unimplemented_entry
|
|
|
|
synchronous_current_elsp_elx:
|
|
save_current_context
|
|
bl exception_common
|
|
restore_previous_context
|
|
eret
|
|
|
|
irq_current_elsp_elx:
|
|
save_current_context
|
|
bl handle_interrupt
|
|
restore_previous_context
|
|
eret
|
|
|
|
fiq_current_elsp_elx:
|
|
save_current_context
|
|
bl exception_common
|
|
restore_previous_context
|
|
eret
|
|
|
|
system_error_current_elsp_elx:
|
|
save_current_context
|
|
bl exception_common
|
|
restore_previous_context
|
|
eret
|
|
|
|
synchronous_current_elsp_el0:
|
|
save_current_context
|
|
bl exception_common
|
|
restore_previous_context
|
|
eret
|
|
|
|
irq_current_elsp_el0:
|
|
save_current_context
|
|
bl handle_interrupt
|
|
restore_previous_context
|
|
eret
|
|
|
|
fiq_current_elsp_el0:
|
|
save_current_context
|
|
bl exception_common
|
|
restore_previous_context
|
|
eret
|
|
|
|
system_error_current_elsp_el0:
|
|
save_current_context
|
|
bl exception_common
|
|
restore_previous_context
|
|
eret
|
|
|
|
synchronous_lower_el:
|
|
save_current_context
|
|
bl exception_common
|
|
restore_previous_context
|
|
eret
|
|
|
|
irq_lower_el:
|
|
save_current_context
|
|
bl handle_interrupt
|
|
restore_previous_context
|
|
eret
|
|
|
|
fiq_lower_el:
|
|
save_current_context
|
|
bl exception_common
|
|
restore_previous_context
|
|
eret
|
|
|
|
system_error_lower_el:
|
|
save_current_context
|
|
bl exception_common
|
|
restore_previous_context
|
|
eret
|
|
|
|
.global restore_context_and_eret
|
|
restore_context_and_eret:
|
|
restore_previous_context
|
|
eret
|