blob: 60b5595566c9985e8af58f98fe4e05810a4f7e9c [file] [log] [blame]
Varun Wadekardc799302015-12-28 16:36:42 -08001/*
Varun Wadekar6e62ad92018-01-04 13:41:27 -08002 * Copyright (c) 2016-2018, ARM Limited and Contributors. All rights reserved.
Varun Wadekardc799302015-12-28 16:36:42 -08003 *
dp-armfa3cf0b2017-05-03 09:38:09 +01004 * SPDX-License-Identifier: BSD-3-Clause
Varun Wadekardc799302015-12-28 16:36:42 -08005 */
6
Varun Wadekardc799302015-12-28 16:36:42 -08007#include <assert.h>
Antonio Nino Diaze0f90632018-12-14 00:18:21 +00008
9#include <arch_helpers.h>
10#include <bl31/interrupt_mgmt.h>
11#include <common/bl_common.h>
12#include <common/debug.h>
Varun Wadekardc799302015-12-28 16:36:42 -080013#include <context.h>
Varun Wadekardc799302015-12-28 16:36:42 -080014#include <denver.h>
Antonio Nino Diaze0f90632018-12-14 00:18:21 +000015#include <lib/bakery_lock.h>
16#include <lib/el3_runtime/context_mgmt.h>
17#include <plat/common/platform.h>
18
Varun Wadekarc6041c92018-01-26 10:33:42 -080019#if ENABLE_WDT_LEGACY_FIQ_HANDLING
20#include <flowctrl.h>
21#endif
Varun Wadekardc799302015-12-28 16:36:42 -080022#include <tegra_def.h>
23#include <tegra_private.h>
24
Varun Wadekarc6041c92018-01-26 10:33:42 -080025/* Legacy FIQ used by earlier Tegra platforms */
26#define LEGACY_FIQ_PPI_WDT 28U
27
Anthony Zhoud1d39a42017-02-24 14:44:21 +080028static DEFINE_BAKERY_LOCK(tegra_fiq_lock);
Varun Wadekardc799302015-12-28 16:36:42 -080029
30/*******************************************************************************
31 * Static variables
32 ******************************************************************************/
33static uint64_t ns_fiq_handler_addr;
Anthony Zhoud1d39a42017-02-24 14:44:21 +080034static uint32_t fiq_handler_active;
Varun Wadekardc799302015-12-28 16:36:42 -080035static pcpu_fiq_state_t fiq_state[PLATFORM_CORE_COUNT];
36
37/*******************************************************************************
38 * Handler for FIQ interrupts
39 ******************************************************************************/
40static uint64_t tegra_fiq_interrupt_handler(uint32_t id,
41 uint32_t flags,
42 void *handle,
43 void *cookie)
44{
45 cpu_context_t *ctx = cm_get_context(NON_SECURE);
46 el3_state_t *el3state_ctx = get_el3state_ctx(ctx);
Anthony Zhoud1d39a42017-02-24 14:44:21 +080047 uint32_t cpu = plat_my_core_pos();
Varun Wadekardc799302015-12-28 16:36:42 -080048 uint32_t irq;
49
Anthony Zhoua2e96ad2017-05-08 20:29:33 +080050 (void)id;
51 (void)flags;
52 (void)handle;
53 (void)cookie;
54
Varun Wadekardc799302015-12-28 16:36:42 -080055 /*
Varun Wadekar6e62ad92018-01-04 13:41:27 -080056 * Read the pending interrupt ID
Varun Wadekardc799302015-12-28 16:36:42 -080057 */
Varun Wadekar6e62ad92018-01-04 13:41:27 -080058 irq = plat_ic_get_pending_interrupt_id();
Varun Wadekardc799302015-12-28 16:36:42 -080059
Varun Wadekar6e62ad92018-01-04 13:41:27 -080060 bakery_lock_get(&tegra_fiq_lock);
Varun Wadekardc799302015-12-28 16:36:42 -080061
62 /*
Varun Wadekar6e62ad92018-01-04 13:41:27 -080063 * Jump to NS world only if the NS world's FIQ handler has
64 * been registered
Varun Wadekardc799302015-12-28 16:36:42 -080065 */
Varun Wadekar6e62ad92018-01-04 13:41:27 -080066 if (ns_fiq_handler_addr != 0U) {
67
68 /*
69 * The FIQ was generated when the execution was in the non-secure
70 * world. Save the context registers to start with.
71 */
72 cm_el1_sysregs_context_save(NON_SECURE);
73
74 /*
75 * Save elr_el3 and spsr_el3 from the saved context, and overwrite
76 * the context with the NS fiq_handler_addr and SPSR value.
77 */
78 fiq_state[cpu].elr_el3 = read_ctx_reg((el3state_ctx), (uint32_t)(CTX_ELR_EL3));
79 fiq_state[cpu].spsr_el3 = read_ctx_reg((el3state_ctx), (uint32_t)(CTX_SPSR_EL3));
80
81 /*
82 * Set the new ELR to continue execution in the NS world using the
83 * FIQ handler registered earlier.
84 */
85 cm_set_elr_el3(NON_SECURE, ns_fiq_handler_addr);
86 }
Varun Wadekarc6041c92018-01-26 10:33:42 -080087
88#if ENABLE_WDT_LEGACY_FIQ_HANDLING
89 /*
90 * Tegra platforms that use LEGACY_FIQ as the watchdog timer FIQ
91 * need to issue an IPI to other CPUs, to allow them to handle
92 * the "system hung" scenario. This interrupt is passed to the GICD
93 * via the Flow Controller. So, once we receive this interrupt,
94 * disable the routing so that we can mark it as "complete" in the
95 * GIC later.
96 */
97 if (irq == LEGACY_FIQ_PPI_WDT) {
98 tegra_fc_disable_fiq_to_ccplex_routing();
99 }
100#endif
Varun Wadekardc799302015-12-28 16:36:42 -0800101
102 /*
103 * Mark this interrupt as complete to avoid a FIQ storm.
104 */
Anthony Zhoud1d39a42017-02-24 14:44:21 +0800105 if (irq < 1022U) {
Varun Wadekar6e62ad92018-01-04 13:41:27 -0800106 (void)plat_ic_acknowledge_interrupt();
Varun Wadekardc799302015-12-28 16:36:42 -0800107 plat_ic_end_of_interrupt(irq);
Anthony Zhoud1d39a42017-02-24 14:44:21 +0800108 }
Varun Wadekardc799302015-12-28 16:36:42 -0800109
110 bakery_lock_release(&tegra_fiq_lock);
111
112 return 0;
113}
114
115/*******************************************************************************
116 * Setup handler for FIQ interrupts
117 ******************************************************************************/
118void tegra_fiq_handler_setup(void)
119{
Anthony Zhoud1d39a42017-02-24 14:44:21 +0800120 uint32_t flags;
121 int32_t rc;
Varun Wadekardc799302015-12-28 16:36:42 -0800122
123 /* return if already registered */
Anthony Zhoud1d39a42017-02-24 14:44:21 +0800124 if (fiq_handler_active == 0U) {
125 /*
126 * Register an interrupt handler for FIQ interrupts generated for
127 * NS interrupt sources
128 */
129 flags = 0U;
130 set_interrupt_rm_flag((flags), (NON_SECURE));
131 rc = register_interrupt_type_handler(INTR_TYPE_EL3,
132 tegra_fiq_interrupt_handler,
133 flags);
134 if (rc != 0) {
135 panic();
136 }
Varun Wadekardc799302015-12-28 16:36:42 -0800137
Anthony Zhoud1d39a42017-02-24 14:44:21 +0800138 /* handler is now active */
139 fiq_handler_active = 1;
140 }
Varun Wadekardc799302015-12-28 16:36:42 -0800141}
142
143/*******************************************************************************
144 * Validate and store NS world's entrypoint for FIQ interrupts
145 ******************************************************************************/
146void tegra_fiq_set_ns_entrypoint(uint64_t entrypoint)
147{
148 ns_fiq_handler_addr = entrypoint;
149}
150
151/*******************************************************************************
152 * Handler to return the NS EL1/EL0 CPU context
153 ******************************************************************************/
Anthony Zhoud1d39a42017-02-24 14:44:21 +0800154int32_t tegra_fiq_get_intr_context(void)
Varun Wadekardc799302015-12-28 16:36:42 -0800155{
156 cpu_context_t *ctx = cm_get_context(NON_SECURE);
157 gp_regs_t *gpregs_ctx = get_gpregs_ctx(ctx);
Anthony Zhoud1d39a42017-02-24 14:44:21 +0800158 const el1_sys_regs_t *el1state_ctx = get_sysregs_ctx(ctx);
159 uint32_t cpu = plat_my_core_pos();
Varun Wadekardc799302015-12-28 16:36:42 -0800160 uint64_t val;
161
162 /*
163 * We store the ELR_EL3, SPSR_EL3, SP_EL0 and SP_EL1 registers so
164 * that el3_exit() sends these values back to the NS world.
165 */
Anthony Zhoud1d39a42017-02-24 14:44:21 +0800166 write_ctx_reg((gpregs_ctx), (uint32_t)(CTX_GPREG_X0), (fiq_state[cpu].elr_el3));
167 write_ctx_reg((gpregs_ctx), (uint32_t)(CTX_GPREG_X1), (fiq_state[cpu].spsr_el3));
Varun Wadekardc799302015-12-28 16:36:42 -0800168
Anthony Zhoud1d39a42017-02-24 14:44:21 +0800169 val = read_ctx_reg((gpregs_ctx), (uint32_t)(CTX_GPREG_SP_EL0));
170 write_ctx_reg((gpregs_ctx), (uint32_t)(CTX_GPREG_X2), (val));
Varun Wadekardc799302015-12-28 16:36:42 -0800171
Anthony Zhoud1d39a42017-02-24 14:44:21 +0800172 val = read_ctx_reg((el1state_ctx), (uint32_t)(CTX_SP_EL1));
173 write_ctx_reg((gpregs_ctx), (uint32_t)(CTX_GPREG_X3), (val));
Varun Wadekardc799302015-12-28 16:36:42 -0800174
175 return 0;
176}