178e2bd10SVarun Wadekar /* 278e2bd10SVarun Wadekar * Copyright (c) 2016, ARM Limited and Contributors. All rights reserved. 378e2bd10SVarun Wadekar * 4*82cb2c1aSdp-arm * SPDX-License-Identifier: BSD-3-Clause 578e2bd10SVarun Wadekar */ 678e2bd10SVarun Wadekar 778e2bd10SVarun Wadekar #include <arch_helpers.h> 878e2bd10SVarun Wadekar #include <assert.h> 978e2bd10SVarun Wadekar #include <bakery_lock.h> 1078e2bd10SVarun Wadekar #include <bl_common.h> 1178e2bd10SVarun Wadekar #include <context.h> 1278e2bd10SVarun Wadekar #include <context_mgmt.h> 1378e2bd10SVarun Wadekar #include <debug.h> 1478e2bd10SVarun Wadekar #include <denver.h> 1578e2bd10SVarun Wadekar #include <gic_v2.h> 1678e2bd10SVarun Wadekar #include <interrupt_mgmt.h> 1778e2bd10SVarun Wadekar #include <platform.h> 1878e2bd10SVarun Wadekar #include <tegra_def.h> 1978e2bd10SVarun Wadekar #include <tegra_private.h> 2078e2bd10SVarun Wadekar 2178e2bd10SVarun Wadekar DEFINE_BAKERY_LOCK(tegra_fiq_lock); 2278e2bd10SVarun Wadekar 2378e2bd10SVarun Wadekar /******************************************************************************* 2478e2bd10SVarun Wadekar * Static variables 2578e2bd10SVarun Wadekar ******************************************************************************/ 2678e2bd10SVarun Wadekar static uint64_t ns_fiq_handler_addr; 2778e2bd10SVarun Wadekar static unsigned int fiq_handler_active; 2878e2bd10SVarun Wadekar static pcpu_fiq_state_t fiq_state[PLATFORM_CORE_COUNT]; 2978e2bd10SVarun Wadekar 3078e2bd10SVarun Wadekar /******************************************************************************* 3178e2bd10SVarun Wadekar * Handler for FIQ interrupts 3278e2bd10SVarun Wadekar ******************************************************************************/ 3378e2bd10SVarun Wadekar static uint64_t tegra_fiq_interrupt_handler(uint32_t id, 3478e2bd10SVarun Wadekar uint32_t flags, 3578e2bd10SVarun Wadekar void *handle, 3678e2bd10SVarun Wadekar void *cookie) 3778e2bd10SVarun Wadekar { 3878e2bd10SVarun Wadekar cpu_context_t *ctx = cm_get_context(NON_SECURE); 3978e2bd10SVarun Wadekar el3_state_t *el3state_ctx = get_el3state_ctx(ctx); 4078e2bd10SVarun Wadekar int cpu = plat_my_core_pos(); 4178e2bd10SVarun Wadekar uint32_t irq; 4278e2bd10SVarun Wadekar 4378e2bd10SVarun Wadekar bakery_lock_get(&tegra_fiq_lock); 4478e2bd10SVarun Wadekar 4578e2bd10SVarun Wadekar /* 4678e2bd10SVarun Wadekar * The FIQ was generated when the execution was in the non-secure 4778e2bd10SVarun Wadekar * world. Save the context registers to start with. 4878e2bd10SVarun Wadekar */ 4978e2bd10SVarun Wadekar cm_el1_sysregs_context_save(NON_SECURE); 5078e2bd10SVarun Wadekar 5178e2bd10SVarun Wadekar /* 5278e2bd10SVarun Wadekar * Save elr_el3 and spsr_el3 from the saved context, and overwrite 5378e2bd10SVarun Wadekar * the context with the NS fiq_handler_addr and SPSR value. 5478e2bd10SVarun Wadekar */ 5578e2bd10SVarun Wadekar fiq_state[cpu].elr_el3 = read_ctx_reg(el3state_ctx, CTX_ELR_EL3); 5678e2bd10SVarun Wadekar fiq_state[cpu].spsr_el3 = read_ctx_reg(el3state_ctx, CTX_SPSR_EL3); 5778e2bd10SVarun Wadekar 5878e2bd10SVarun Wadekar /* 5978e2bd10SVarun Wadekar * Set the new ELR to continue execution in the NS world using the 6078e2bd10SVarun Wadekar * FIQ handler registered earlier. 6178e2bd10SVarun Wadekar */ 6278e2bd10SVarun Wadekar assert(ns_fiq_handler_addr); 6378e2bd10SVarun Wadekar write_ctx_reg(el3state_ctx, CTX_ELR_EL3, ns_fiq_handler_addr); 6478e2bd10SVarun Wadekar 6578e2bd10SVarun Wadekar /* 6678e2bd10SVarun Wadekar * Mark this interrupt as complete to avoid a FIQ storm. 6778e2bd10SVarun Wadekar */ 6878e2bd10SVarun Wadekar irq = plat_ic_acknowledge_interrupt(); 6978e2bd10SVarun Wadekar if (irq < 1022) 7078e2bd10SVarun Wadekar plat_ic_end_of_interrupt(irq); 7178e2bd10SVarun Wadekar 7278e2bd10SVarun Wadekar bakery_lock_release(&tegra_fiq_lock); 7378e2bd10SVarun Wadekar 7478e2bd10SVarun Wadekar return 0; 7578e2bd10SVarun Wadekar } 7678e2bd10SVarun Wadekar 7778e2bd10SVarun Wadekar /******************************************************************************* 7878e2bd10SVarun Wadekar * Setup handler for FIQ interrupts 7978e2bd10SVarun Wadekar ******************************************************************************/ 8078e2bd10SVarun Wadekar void tegra_fiq_handler_setup(void) 8178e2bd10SVarun Wadekar { 8278e2bd10SVarun Wadekar uint64_t flags; 8378e2bd10SVarun Wadekar int rc; 8478e2bd10SVarun Wadekar 8578e2bd10SVarun Wadekar /* return if already registered */ 8678e2bd10SVarun Wadekar if (fiq_handler_active) 8778e2bd10SVarun Wadekar return; 8878e2bd10SVarun Wadekar 8978e2bd10SVarun Wadekar /* 9078e2bd10SVarun Wadekar * Register an interrupt handler for FIQ interrupts generated for 9178e2bd10SVarun Wadekar * NS interrupt sources 9278e2bd10SVarun Wadekar */ 9378e2bd10SVarun Wadekar flags = 0; 9478e2bd10SVarun Wadekar set_interrupt_rm_flag(flags, NON_SECURE); 9545eab456SVarun Wadekar rc = register_interrupt_type_handler(INTR_TYPE_EL3, 9678e2bd10SVarun Wadekar tegra_fiq_interrupt_handler, 9778e2bd10SVarun Wadekar flags); 9878e2bd10SVarun Wadekar if (rc) 9978e2bd10SVarun Wadekar panic(); 10078e2bd10SVarun Wadekar 10178e2bd10SVarun Wadekar /* handler is now active */ 10278e2bd10SVarun Wadekar fiq_handler_active = 1; 10378e2bd10SVarun Wadekar } 10478e2bd10SVarun Wadekar 10578e2bd10SVarun Wadekar /******************************************************************************* 10678e2bd10SVarun Wadekar * Validate and store NS world's entrypoint for FIQ interrupts 10778e2bd10SVarun Wadekar ******************************************************************************/ 10878e2bd10SVarun Wadekar void tegra_fiq_set_ns_entrypoint(uint64_t entrypoint) 10978e2bd10SVarun Wadekar { 11078e2bd10SVarun Wadekar ns_fiq_handler_addr = entrypoint; 11178e2bd10SVarun Wadekar } 11278e2bd10SVarun Wadekar 11378e2bd10SVarun Wadekar /******************************************************************************* 11478e2bd10SVarun Wadekar * Handler to return the NS EL1/EL0 CPU context 11578e2bd10SVarun Wadekar ******************************************************************************/ 11678e2bd10SVarun Wadekar int tegra_fiq_get_intr_context(void) 11778e2bd10SVarun Wadekar { 11878e2bd10SVarun Wadekar cpu_context_t *ctx = cm_get_context(NON_SECURE); 11978e2bd10SVarun Wadekar gp_regs_t *gpregs_ctx = get_gpregs_ctx(ctx); 12078e2bd10SVarun Wadekar el1_sys_regs_t *el1state_ctx = get_sysregs_ctx(ctx); 12178e2bd10SVarun Wadekar int cpu = plat_my_core_pos(); 12278e2bd10SVarun Wadekar uint64_t val; 12378e2bd10SVarun Wadekar 12478e2bd10SVarun Wadekar /* 12578e2bd10SVarun Wadekar * We store the ELR_EL3, SPSR_EL3, SP_EL0 and SP_EL1 registers so 12678e2bd10SVarun Wadekar * that el3_exit() sends these values back to the NS world. 12778e2bd10SVarun Wadekar */ 12878e2bd10SVarun Wadekar write_ctx_reg(gpregs_ctx, CTX_GPREG_X0, fiq_state[cpu].elr_el3); 12978e2bd10SVarun Wadekar write_ctx_reg(gpregs_ctx, CTX_GPREG_X1, fiq_state[cpu].spsr_el3); 13078e2bd10SVarun Wadekar 13178e2bd10SVarun Wadekar val = read_ctx_reg(gpregs_ctx, CTX_GPREG_SP_EL0); 13278e2bd10SVarun Wadekar write_ctx_reg(gpregs_ctx, CTX_GPREG_X2, val); 13378e2bd10SVarun Wadekar 13478e2bd10SVarun Wadekar val = read_ctx_reg(el1state_ctx, CTX_SP_EL1); 13578e2bd10SVarun Wadekar write_ctx_reg(gpregs_ctx, CTX_GPREG_X3, val); 13678e2bd10SVarun Wadekar 13778e2bd10SVarun Wadekar return 0; 13878e2bd10SVarun Wadekar } 139