diff options
Diffstat (limited to 'src')
-rw-r--r-- | src/arch/arm64/Kconfig | 16 | ||||
-rw-r--r-- | src/arch/arm64/armv8/cache.c | 4 | ||||
-rw-r--r-- | src/arch/arm64/armv8/cpu.S | 13 | ||||
-rw-r--r-- | src/arch/arm64/armv8/exception.c | 8 | ||||
-rw-r--r-- | src/arch/arm64/armv8/mmu.c | 28 | ||||
-rw-r--r-- | src/arch/arm64/boot.c | 4 | ||||
-rw-r--r-- | src/arch/arm64/include/arch/asm.h | 10 | ||||
-rw-r--r-- | src/arch/arm64/include/armv8/arch/cache.h | 3 | ||||
-rw-r--r-- | src/arch/arm64/include/armv8/arch/lib_helpers.h | 51 | ||||
-rw-r--r-- | src/arch/arm64/ramdetect.c | 5 | ||||
-rw-r--r-- | src/arch/arm64/transition.c | 6 | ||||
-rw-r--r-- | src/arch/arm64/transition_asm.S | 7 |
12 files changed, 117 insertions, 38 deletions
diff --git a/src/arch/arm64/Kconfig b/src/arch/arm64/Kconfig index 9b89c37c10..2d71067e45 100644 --- a/src/arch/arm64/Kconfig +++ b/src/arch/arm64/Kconfig @@ -23,6 +23,20 @@ source "src/arch/arm64/armv8/Kconfig" if ARCH_ARM64 +config ARM64_CURRENT_EL + int + default 3 + range 1 3 + help + The exception level on which coreboot is started. Accepted + values are: 1 (EL1), 2 (EL2) and 3 (EL3). This option can be + used to restrict access to available control registers in case + prior firmware already dropped to a lower exception level. By default, + coreboot is the first firmware that runs on the system and should thus + always run on EL3. This option is only provided for edge-case platforms + that require running a different firmware before coreboot which drops + to a lower exception level. + config ARM64_USE_ARCH_TIMER bool default n @@ -30,7 +44,7 @@ config ARM64_USE_ARCH_TIMER config ARM64_USE_ARM_TRUSTED_FIRMWARE bool default n - depends on ARCH_RAMSTAGE_ARM64 + depends on ARCH_RAMSTAGE_ARM64 && ARM64_CURRENT_EL = 3 config ARM64_BL31_EXTERNAL_FILE string "Path to external BL31.ELF (leave empty to build from source)" diff --git a/src/arch/arm64/armv8/cache.c b/src/arch/arm64/armv8/cache.c index dbaedec31d..879ef6297b 100644 --- a/src/arch/arm64/armv8/cache.c +++ b/src/arch/arm64/armv8/cache.c @@ -148,10 +148,12 @@ void dcache_invalidate_by_mva(void const *addr, size_t len) */ void arch_segment_loaded(uintptr_t start, size_t size, int flags) { - uint32_t sctlr = raw_read_sctlr_el3(); + uint32_t sctlr = raw_read_sctlr(); + if (sctlr & SCTLR_C) dcache_clean_by_mva((void *)start, size); else if (sctlr & SCTLR_I) dcache_clean_invalidate_by_mva((void *)start, size); + icache_invalidate_all(); } diff --git a/src/arch/arm64/armv8/cpu.S b/src/arch/arm64/armv8/cpu.S index 04bf6a7021..a40ee64536 100644 --- a/src/arch/arm64/armv8/cpu.S +++ b/src/arch/arm64/armv8/cpu.S @@ -77,10 +77,10 @@ ENDPROC(dcache_clean_invalidate_all) memory (e.g. the stack) in between disabling and flushing the cache. */ ENTRY(mmu_disable) str x30, [sp, #-0x8] - mrs x0, sctlr_el3 + mrs x0, CURRENT_EL(sctlr) mov x1, #~(SCTLR_C | SCTLR_M) and x0, x0, x1 - msr sctlr_el3, x0 + msr CURRENT_EL(sctlr), x0 isb bl dcache_clean_invalidate_all ldr x30, [sp, #-0x8] @@ -102,12 +102,11 @@ ENTRY(arm64_init_cpu) /* x22: SCTLR, return address: x23 (callee-saved by subroutine) */ mov x23, x30 - /* TODO: Assert that we always start running at EL3 */ - mrs x22, sctlr_el3 + mrs x22, CURRENT_EL(sctlr) /* Activate ICache already for speed during cache flush below. */ orr x22, x22, #SCTLR_I - msr sctlr_el3, x22 + msr CURRENT_EL(sctlr), x22 isb /* Invalidate dcache */ @@ -116,13 +115,15 @@ ENTRY(arm64_init_cpu) /* Reinitialize SCTLR from scratch to known-good state. This may disable MMU or DCache. */ ldr w22, =(SCTLR_RES1 | SCTLR_I | SCTLR_SA) - msr sctlr_el3, x22 + msr CURRENT_EL(sctlr), x22 +#if CONFIG_ARM64_CURRENT_EL == EL3 /* Initialize SCR to unmask all interrupts (so that if we get a spurious IRQ/SError we'll see it when it happens, not hang in BL31). This will only have an effect after we DAIFClr in exception_init(). */ mov x22, #SCR_RES1 | SCR_IRQ | SCR_FIQ | SCR_EA msr scr_el3, x22 +#endif /* Invalidate icache and TLB for good measure */ ic iallu diff --git a/src/arch/arm64/armv8/exception.c b/src/arch/arm64/armv8/exception.c index 8583fd5172..6035d749c7 100644 --- a/src/arch/arm64/armv8/exception.c +++ b/src/arch/arm64/armv8/exception.c @@ -51,9 +51,10 @@ static void print_regs(struct exc_state *exc_state) struct regs *regs = &exc_state->regs; printk(BIOS_DEBUG, "ELR = 0x%016llx ESR = 0x%08llx\n", - elx->elr, raw_read_esr_el3()); + elx->elr, raw_read_esr()); printk(BIOS_DEBUG, "FAR = 0x%016llx SPSR = 0x%08llx\n", - raw_read_far_el3(), raw_read_spsr_el3()); + raw_read_far(), raw_read_spsr()); + for (i = 0; i < 30; i += 2) { printk(BIOS_DEBUG, "X%02d = 0x%016llx X%02d = 0x%016llx\n", @@ -173,7 +174,8 @@ static int test_exception_handler(struct exc_state *state, uint64_t vector_id) { /* Update instruction pointer to next instruction. */ state->elx.elr += sizeof(uint32_t); - raw_write_elr_el3(state->elx.elr); + raw_write_elr(state->elx.elr); + return EXC_RET_HANDLED; } diff --git a/src/arch/arm64/armv8/mmu.c b/src/arch/arm64/armv8/mmu.c index 3cedbcf58f..6105f9a9b2 100644 --- a/src/arch/arm64/armv8/mmu.c +++ b/src/arch/arm64/armv8/mmu.c @@ -224,7 +224,7 @@ void mmu_config_range(void *start, size_t size, uint64_t tag) /* ARMv8 MMUs snoop L1 data cache, no need to flush it. */ dsb(); - tlbiall_el3(); + tlbiall(); dsb(); isb(); } @@ -245,15 +245,15 @@ void mmu_init(void) assert((u8 *)root == _ttb); /* Initialize TTBR */ - raw_write_ttbr0_el3((uintptr_t)root); + raw_write_ttbr0((uintptr_t)root); /* Initialize MAIR indices */ - raw_write_mair_el3(MAIR_ATTRIBUTES); + raw_write_mair(MAIR_ATTRIBUTES); /* Initialize TCR flags */ - raw_write_tcr_el3(TCR_TOSZ | TCR_IRGN0_NM_WBWAC | TCR_ORGN0_NM_WBWAC | - TCR_SH0_IS | TCR_TG0_4KB | TCR_PS_256TB | - TCR_TBI_USED); + raw_write_tcr(TCR_TOSZ | TCR_IRGN0_NM_WBWAC | TCR_ORGN0_NM_WBWAC | + TCR_SH0_IS | TCR_TG0_4KB | TCR_PS_256TB | + TCR_TBI_USED); } /* Func : mmu_save_context @@ -264,10 +264,10 @@ void mmu_save_context(struct mmu_context *mmu_context) assert(mmu_context); /* Back-up MAIR_ATTRIBUTES */ - mmu_context->mair = raw_read_mair_el3(); + mmu_context->mair = raw_read_mair(); /* Back-up TCR value */ - mmu_context->tcr = raw_read_tcr_el3(); + mmu_context->tcr = raw_read_tcr(); } /* Func : mmu_restore_context @@ -278,13 +278,13 @@ void mmu_restore_context(const struct mmu_context *mmu_context) assert(mmu_context); /* Restore TTBR */ - raw_write_ttbr0_el3((uintptr_t)_ttb); + raw_write_ttbr0((uintptr_t)_ttb); /* Restore MAIR indices */ - raw_write_mair_el3(mmu_context->mair); + raw_write_mair(mmu_context->mair); /* Restore TCR flags */ - raw_write_tcr_el3(mmu_context->tcr); + raw_write_tcr(mmu_context->tcr); /* invalidate tlb since ttbr is updated. */ tlb_invalidate_all(); @@ -295,8 +295,8 @@ void mmu_enable(void) assert_correct_ttb_mapping(_ttb); assert_correct_ttb_mapping((void *)((uintptr_t)_ettb - 1)); - uint32_t sctlr = raw_read_sctlr_el3(); - sctlr |= SCTLR_C | SCTLR_M | SCTLR_I; - raw_write_sctlr_el3(sctlr); + uint32_t sctlr = raw_read_sctlr(); + raw_write_sctlr(sctlr | SCTLR_C | SCTLR_M | SCTLR_I); + isb(); } diff --git a/src/arch/arm64/boot.c b/src/arch/arm64/boot.c index 89668e85b9..7a8060fa49 100644 --- a/src/arch/arm64/boot.c +++ b/src/arch/arm64/boot.c @@ -18,8 +18,10 @@ static void run_payload(struct prog *prog) if (CONFIG(ARM64_USE_ARM_TRUSTED_FIRMWARE)) run_bl31((u64)doit, (u64)arg, payload_spsr); - else + else if (CONFIG_ARM64_CURRENT_EL == EL3) transition_to_el2(doit, arg, payload_spsr); + else + doit(arg); } void arch_prog_run(struct prog *prog) diff --git a/src/arch/arm64/include/arch/asm.h b/src/arch/arm64/include/arch/asm.h index df5952a576..81921c5932 100644 --- a/src/arch/arm64/include/arch/asm.h +++ b/src/arch/arm64/include/arch/asm.h @@ -28,4 +28,14 @@ ENTRY(name) \ .weak name \ +#if CONFIG_ARM64_CURRENT_EL == 1 +#define CURRENT_EL(reg) reg##_el1 +#elif CONFIG_ARM64_CURRENT_EL == 2 +#define CURRENT_EL(reg) reg##_el2 +#elif CONFIG_ARM64_CURRENT_EL == 3 +#define CURRENT_EL(reg) reg##_el3 +#else +#error "Invalid setting for CONFIG_ARM64_CURRENT_EL!" +#endif + #endif /* __ARM_ARM64_ASM_H */ diff --git a/src/arch/arm64/include/armv8/arch/cache.h b/src/arch/arm64/include/armv8/arch/cache.h index 3a72d40c7a..5097196308 100644 --- a/src/arch/arm64/include/armv8/arch/cache.h +++ b/src/arch/arm64/include/armv8/arch/cache.h @@ -55,7 +55,8 @@ unsigned int dcache_line_bytes(void); static inline void tlb_invalidate_all(void) { /* TLBIALL includes dTLB and iTLB on systems that have them. */ - tlbiall_el3(); + + tlbiall(); dsb(); isb(); } diff --git a/src/arch/arm64/include/armv8/arch/lib_helpers.h b/src/arch/arm64/include/armv8/arch/lib_helpers.h index ff3459a91e..cb6c2abb3d 100644 --- a/src/arch/arm64/include/armv8/arch/lib_helpers.h +++ b/src/arch/arm64/include/armv8/arch/lib_helpers.h @@ -113,10 +113,49 @@ : : "r" (value) : "memory"); \ } +/* + * In order to allow easy access to current EL's registers, + * we export following two functions for each EL register, that + * was passed to the MAKE_REGISTER_ACCESSORS_CURRENT_EL macro. Doing + * that, eliminates, or at least hides, repetitive branching on the + * current EL across the arm64 codebase. + * + * MAKE_REGISTER_ACCESSORS_CURRENT_EL was hooked into MAKE_REGISTER_ACCESSORS_EL123, + * in order to automatically generate current_el accessors only for registers which + * exist on EL1, EL2 and EL3. + * + * Note, that we don't handle EL0 here, as most of the defined registers do not + * have an EL0 variant (see MAKE_REGISTER_ACCESSORS_EL123). + * + * Important: + * - target register should be specified without the '_elx' suffix + * - only registers which exist in EL1, EL2 and EL3 should be passed + * to the MAKE_REGISTER_ACCESSORS_CURRENT_EL macro + */ +#define MAKE_REGISTER_ACCESSORS_CURRENT_EL(reg) \ + static inline uint64_t raw_read_##reg(void) \ + { \ + if (CONFIG_ARM64_CURRENT_EL == EL1) \ + return raw_read_##reg##_el1(); \ + else if (CONFIG_ARM64_CURRENT_EL == EL2) \ + return raw_read_##reg##_el2(); \ + return raw_read_##reg##_el3(); \ + } \ + static inline void raw_write_##reg(uint64_t value) \ + { \ + if (CONFIG_ARM64_CURRENT_EL == EL1) \ + raw_write_##reg##_el1(value); \ + else if (CONFIG_ARM64_CURRENT_EL == EL2) \ + raw_write_##reg##_el2(value); \ + else \ + raw_write_##reg##_el3(value); \ + } + #define MAKE_REGISTER_ACCESSORS_EL123(reg) \ MAKE_REGISTER_ACCESSORS(reg##_el1) \ MAKE_REGISTER_ACCESSORS(reg##_el2) \ - MAKE_REGISTER_ACCESSORS(reg##_el3) + MAKE_REGISTER_ACCESSORS(reg##_el3) \ + MAKE_REGISTER_ACCESSORS_CURRENT_EL(reg) /* Architectural register accessors */ MAKE_REGISTER_ACCESSORS_EL123(actlr) @@ -318,6 +357,16 @@ static inline void tlbiall_el3(void) __asm__ __volatile__("tlbi alle3\n\t" : : : "memory"); } +static inline void tlbiall(void) +{ + if (CONFIG_ARM64_CURRENT_EL == EL1) + tlbiall_el1(); + else if (CONFIG_ARM64_CURRENT_EL == EL2) + tlbiall_el2(); + else + tlbiall_el3(); +} + static inline void tlbiallis_el1(void) { __asm__ __volatile__("tlbi alle1is\n\t" : : : "memory"); diff --git a/src/arch/arm64/ramdetect.c b/src/arch/arm64/ramdetect.c index 2f6a1cd50c..c99c5b46c6 100644 --- a/src/arch/arm64/ramdetect.c +++ b/src/arch/arm64/ramdetect.c @@ -13,12 +13,13 @@ static enum { static int abort_checker(struct exc_state *state, uint64_t vector_id) { - if (raw_read_esr_el3() >> 26 != 0x25) + if (raw_read_esr() >> 26 != 0x25) return EXC_RET_IGNORED; /* Not a data abort. */ abort_state = ABORT_CHECKER_TRIGGERED; state->elx.elr += sizeof(uint32_t); /* Jump over faulting instruction. */ - raw_write_elr_el3(state->elx.elr); + raw_write_elr(state->elx.elr); + return EXC_RET_HANDLED; } diff --git a/src/arch/arm64/transition.c b/src/arch/arm64/transition.c index e5c83bf93f..8b84ce2415 100644 --- a/src/arch/arm64/transition.c +++ b/src/arch/arm64/transition.c @@ -17,7 +17,9 @@ void exc_entry(struct exc_state *exc_state, uint64_t id) struct regs *regs = &exc_state->regs; uint8_t elx_mode; - elx->spsr = raw_read_spsr_el3(); + elx->spsr = raw_read_spsr(); + elx->elr = raw_read_elr(); + elx_mode = get_mode_from_spsr(elx->spsr); if (elx_mode == SPSR_USE_H) @@ -25,8 +27,6 @@ void exc_entry(struct exc_state *exc_state, uint64_t id) else regs->sp = raw_read_sp_el0(); - elx->elr = raw_read_elr_el3(); - exc_dispatch(exc_state, id); } diff --git a/src/arch/arm64/transition_asm.S b/src/arch/arm64/transition_asm.S index 73a6fb6c04..b4522e02da 100644 --- a/src/arch/arm64/transition_asm.S +++ b/src/arch/arm64/transition_asm.S @@ -142,19 +142,16 @@ ENTRY(exc_exit) ENDPROC(exc_exit) /* - * exception_init_asm: Initialize VBAR and point SP_EL3 to exception stack. + * exception_init_asm: Initialize VBAR and point SP_ELx to exception stack. * Also unmask aborts now that we can report them. x0 = end of exception stack */ ENTRY(exception_init_asm) msr SPSel, #SPSR_USE_H mov sp, x0 msr SPSel, #SPSR_USE_L - adr x0, exc_vectors - msr vbar_el3, x0 - + msr CURRENT_EL(vbar), x0 msr DAIFClr, #0xf - dsb sy isb ret |