178e2bd10SVarun Wadekar /* 278e2bd10SVarun Wadekar * Copyright (c) 2016, ARM Limited and Contributors. All rights reserved. 378e2bd10SVarun Wadekar * 482cb2c1aSdp-arm * SPDX-License-Identifier: BSD-3-Clause 578e2bd10SVarun Wadekar */ 678e2bd10SVarun Wadekar 778e2bd10SVarun Wadekar #include <assert.h> 809d40e0eSAntonio Nino Diaz 909d40e0eSAntonio Nino Diaz #include <arch_helpers.h> 1009d40e0eSAntonio Nino Diaz #include <bl31/interrupt_mgmt.h> 1109d40e0eSAntonio Nino Diaz #include <common/bl_common.h> 1209d40e0eSAntonio Nino Diaz #include <common/debug.h> 1378e2bd10SVarun Wadekar #include <context.h> 1478e2bd10SVarun Wadekar #include <denver.h> 1509d40e0eSAntonio Nino Diaz #include <lib/bakery_lock.h> 1609d40e0eSAntonio Nino Diaz #include <lib/el3_runtime/context_mgmt.h> 1709d40e0eSAntonio Nino Diaz #include <plat/common/platform.h> 1809d40e0eSAntonio Nino Diaz 1978e2bd10SVarun Wadekar #include <tegra_def.h> 2078e2bd10SVarun Wadekar #include <tegra_private.h> 2178e2bd10SVarun Wadekar 225bd1a177SAnthony Zhou static DEFINE_BAKERY_LOCK(tegra_fiq_lock); 2378e2bd10SVarun Wadekar 2478e2bd10SVarun Wadekar /******************************************************************************* 2578e2bd10SVarun Wadekar * Static variables 2678e2bd10SVarun Wadekar ******************************************************************************/ 2778e2bd10SVarun Wadekar static uint64_t ns_fiq_handler_addr; 285bd1a177SAnthony Zhou static uint32_t fiq_handler_active; 2978e2bd10SVarun Wadekar static pcpu_fiq_state_t fiq_state[PLATFORM_CORE_COUNT]; 3078e2bd10SVarun Wadekar 3178e2bd10SVarun Wadekar /******************************************************************************* 3278e2bd10SVarun Wadekar * Handler for FIQ interrupts 3378e2bd10SVarun Wadekar ******************************************************************************/ 3478e2bd10SVarun Wadekar static uint64_t tegra_fiq_interrupt_handler(uint32_t id, 3578e2bd10SVarun Wadekar uint32_t flags, 3678e2bd10SVarun Wadekar void *handle, 3778e2bd10SVarun Wadekar void *cookie) 3878e2bd10SVarun Wadekar { 3978e2bd10SVarun Wadekar cpu_context_t *ctx = cm_get_context(NON_SECURE); 4078e2bd10SVarun Wadekar el3_state_t *el3state_ctx = get_el3state_ctx(ctx); 415bd1a177SAnthony Zhou uint32_t cpu = plat_my_core_pos(); 4278e2bd10SVarun Wadekar uint32_t irq; 4378e2bd10SVarun Wadekar 44*82e73ae7SAnthony Zhou (void)id; 45*82e73ae7SAnthony Zhou (void)flags; 46*82e73ae7SAnthony Zhou (void)handle; 47*82e73ae7SAnthony Zhou (void)cookie; 48*82e73ae7SAnthony Zhou 4978e2bd10SVarun Wadekar bakery_lock_get(&tegra_fiq_lock); 5078e2bd10SVarun Wadekar 5178e2bd10SVarun Wadekar /* 5278e2bd10SVarun Wadekar * The FIQ was generated when the execution was in the non-secure 5378e2bd10SVarun Wadekar * world. Save the context registers to start with. 5478e2bd10SVarun Wadekar */ 5578e2bd10SVarun Wadekar cm_el1_sysregs_context_save(NON_SECURE); 5678e2bd10SVarun Wadekar 5778e2bd10SVarun Wadekar /* 5878e2bd10SVarun Wadekar * Save elr_el3 and spsr_el3 from the saved context, and overwrite 5978e2bd10SVarun Wadekar * the context with the NS fiq_handler_addr and SPSR value. 6078e2bd10SVarun Wadekar */ 615bd1a177SAnthony Zhou fiq_state[cpu].elr_el3 = read_ctx_reg((el3state_ctx), (uint32_t)(CTX_ELR_EL3)); 625bd1a177SAnthony Zhou fiq_state[cpu].spsr_el3 = read_ctx_reg((el3state_ctx), (uint32_t)(CTX_SPSR_EL3)); 6378e2bd10SVarun Wadekar 6478e2bd10SVarun Wadekar /* 6578e2bd10SVarun Wadekar * Set the new ELR to continue execution in the NS world using the 6678e2bd10SVarun Wadekar * FIQ handler registered earlier. 6778e2bd10SVarun Wadekar */ 6878e2bd10SVarun Wadekar assert(ns_fiq_handler_addr); 695bd1a177SAnthony Zhou write_ctx_reg((el3state_ctx), (uint32_t)(CTX_ELR_EL3), (ns_fiq_handler_addr)); 7078e2bd10SVarun Wadekar 7178e2bd10SVarun Wadekar /* 7278e2bd10SVarun Wadekar * Mark this interrupt as complete to avoid a FIQ storm. 7378e2bd10SVarun Wadekar */ 7478e2bd10SVarun Wadekar irq = plat_ic_acknowledge_interrupt(); 755bd1a177SAnthony Zhou if (irq < 1022U) { 7678e2bd10SVarun Wadekar plat_ic_end_of_interrupt(irq); 775bd1a177SAnthony Zhou } 7878e2bd10SVarun Wadekar 7978e2bd10SVarun Wadekar bakery_lock_release(&tegra_fiq_lock); 8078e2bd10SVarun Wadekar 8178e2bd10SVarun Wadekar return 0; 8278e2bd10SVarun Wadekar } 8378e2bd10SVarun Wadekar 8478e2bd10SVarun Wadekar /******************************************************************************* 8578e2bd10SVarun Wadekar * Setup handler for FIQ interrupts 8678e2bd10SVarun Wadekar ******************************************************************************/ 8778e2bd10SVarun Wadekar void tegra_fiq_handler_setup(void) 8878e2bd10SVarun Wadekar { 895bd1a177SAnthony Zhou uint32_t flags; 905bd1a177SAnthony Zhou int32_t rc; 9178e2bd10SVarun Wadekar 9278e2bd10SVarun Wadekar /* return if already registered */ 935bd1a177SAnthony Zhou if (fiq_handler_active == 0U) { 9478e2bd10SVarun Wadekar /* 9578e2bd10SVarun Wadekar * Register an interrupt handler for FIQ interrupts generated for 9678e2bd10SVarun Wadekar * NS interrupt sources 9778e2bd10SVarun Wadekar */ 985bd1a177SAnthony Zhou flags = 0U; 995bd1a177SAnthony Zhou set_interrupt_rm_flag((flags), (NON_SECURE)); 10045eab456SVarun Wadekar rc = register_interrupt_type_handler(INTR_TYPE_EL3, 10178e2bd10SVarun Wadekar tegra_fiq_interrupt_handler, 10278e2bd10SVarun Wadekar flags); 1035bd1a177SAnthony Zhou if (rc != 0) { 10478e2bd10SVarun Wadekar panic(); 1055bd1a177SAnthony Zhou } 10678e2bd10SVarun Wadekar 10778e2bd10SVarun Wadekar /* handler is now active */ 10878e2bd10SVarun Wadekar fiq_handler_active = 1; 10978e2bd10SVarun Wadekar } 1105bd1a177SAnthony Zhou } 11178e2bd10SVarun Wadekar 11278e2bd10SVarun Wadekar /******************************************************************************* 11378e2bd10SVarun Wadekar * Validate and store NS world's entrypoint for FIQ interrupts 11478e2bd10SVarun Wadekar ******************************************************************************/ 11578e2bd10SVarun Wadekar void tegra_fiq_set_ns_entrypoint(uint64_t entrypoint) 11678e2bd10SVarun Wadekar { 11778e2bd10SVarun Wadekar ns_fiq_handler_addr = entrypoint; 11878e2bd10SVarun Wadekar } 11978e2bd10SVarun Wadekar 12078e2bd10SVarun Wadekar /******************************************************************************* 12178e2bd10SVarun Wadekar * Handler to return the NS EL1/EL0 CPU context 12278e2bd10SVarun Wadekar ******************************************************************************/ 1235bd1a177SAnthony Zhou int32_t tegra_fiq_get_intr_context(void) 12478e2bd10SVarun Wadekar { 12578e2bd10SVarun Wadekar cpu_context_t *ctx = cm_get_context(NON_SECURE); 12678e2bd10SVarun Wadekar gp_regs_t *gpregs_ctx = get_gpregs_ctx(ctx); 1275bd1a177SAnthony Zhou const el1_sys_regs_t *el1state_ctx = get_sysregs_ctx(ctx); 1285bd1a177SAnthony Zhou uint32_t cpu = plat_my_core_pos(); 12978e2bd10SVarun Wadekar uint64_t val; 13078e2bd10SVarun Wadekar 13178e2bd10SVarun Wadekar /* 13278e2bd10SVarun Wadekar * We store the ELR_EL3, SPSR_EL3, SP_EL0 and SP_EL1 registers so 13378e2bd10SVarun Wadekar * that el3_exit() sends these values back to the NS world. 13478e2bd10SVarun Wadekar */ 1355bd1a177SAnthony Zhou write_ctx_reg((gpregs_ctx), (uint32_t)(CTX_GPREG_X0), (fiq_state[cpu].elr_el3)); 1365bd1a177SAnthony Zhou write_ctx_reg((gpregs_ctx), (uint32_t)(CTX_GPREG_X1), (fiq_state[cpu].spsr_el3)); 13778e2bd10SVarun Wadekar 1385bd1a177SAnthony Zhou val = read_ctx_reg((gpregs_ctx), (uint32_t)(CTX_GPREG_SP_EL0)); 1395bd1a177SAnthony Zhou write_ctx_reg((gpregs_ctx), (uint32_t)(CTX_GPREG_X2), (val)); 14078e2bd10SVarun Wadekar 1415bd1a177SAnthony Zhou val = read_ctx_reg((el1state_ctx), (uint32_t)(CTX_SP_EL1)); 1425bd1a177SAnthony Zhou write_ctx_reg((gpregs_ctx), (uint32_t)(CTX_GPREG_X3), (val)); 14378e2bd10SVarun Wadekar 14478e2bd10SVarun Wadekar return 0; 14578e2bd10SVarun Wadekar } 146