tegra_gic.c 10 KB
Newer Older
1
2
3
/*
 * Copyright (c) 2015, ARM Limited and Contributors. All rights reserved.
 *
dp-arm's avatar
dp-arm committed
4
 * SPDX-License-Identifier: BSD-3-Clause
5
6
7
 */

#include <arch_helpers.h>
8
#include <assert.h>
9
10
11
12
13
14
#include <bl_common.h>
#include <debug.h>
#include <interrupt_mgmt.h>
#include <platform.h>
#include <stdint.h>
#include <tegra_def.h>
15
#include <tegra_private.h>
16

17
18
19
20
21
22
23
/* Value used to initialize Non-Secure IRQ priorities four at a time */
#define GICD_IPRIORITYR_DEF_VAL \
	(GIC_HIGHEST_NS_PRIORITY | \
	(GIC_HIGHEST_NS_PRIORITY << 8) | \
	(GIC_HIGHEST_NS_PRIORITY << 16) | \
	(GIC_HIGHEST_NS_PRIORITY << 24))

24
static const irq_sec_cfg_t *g_irq_sec_ptr;
Varun Wadekar's avatar
Varun Wadekar committed
25
static uint32_t g_num_irqs;
26

27
28
29
30
31
32
/*******************************************************************************
 * Place the cpu interface in a state where it can never make a cpu exit wfi as
 * as result of an asserted interrupt. This is critical for powering down a cpu
 ******************************************************************************/
void tegra_gic_cpuif_deactivate(void)
{
Varun Wadekar's avatar
Varun Wadekar committed
33
	uint32_t val;
34
35
36
37
38
39
40
41
42
43
44
45
46

	/* Disable secure, non-secure interrupts and disable their bypass */
	val = gicc_read_ctlr(TEGRA_GICC_BASE);
	val &= ~(ENABLE_GRP0 | ENABLE_GRP1);
	val |= FIQ_BYP_DIS_GRP1 | FIQ_BYP_DIS_GRP0;
	val |= IRQ_BYP_DIS_GRP0 | IRQ_BYP_DIS_GRP1;
	gicc_write_ctlr(TEGRA_GICC_BASE, val);
}

/*******************************************************************************
 * Enable secure interrupts and set the priority mask register to allow all
 * interrupts to trickle in.
 ******************************************************************************/
Varun Wadekar's avatar
Varun Wadekar committed
47
static void tegra_gic_cpuif_setup(uint32_t gicc_base)
48
{
Varun Wadekar's avatar
Varun Wadekar committed
49
	uint32_t val;
50
51
52
53
54

	val = ENABLE_GRP0 | ENABLE_GRP1 | FIQ_EN | FIQ_BYP_DIS_GRP0;
	val |= IRQ_BYP_DIS_GRP0 | FIQ_BYP_DIS_GRP1 | IRQ_BYP_DIS_GRP1;

	gicc_write_ctlr(gicc_base, val);
55
56
57
	gicc_write_pmr(gicc_base, GIC_PRI_MASK);
}

58
59
60
61
/*******************************************************************************
 * Per cpu gic distributor setup which will be done by all cpus after a cold
 * boot/hotplug. This marks out the secure interrupts & enables them.
 ******************************************************************************/
Varun Wadekar's avatar
Varun Wadekar committed
62
static void tegra_gic_pcpu_distif_setup(uint32_t gicd_base)
63
{
Varun Wadekar's avatar
Varun Wadekar committed
64
	uint32_t index, sec_ppi_sgi_mask = 0;
65

Varun Wadekar's avatar
Varun Wadekar committed
66
	assert(gicd_base != 0U);
67
68

	/* Setup PPI priorities doing four at a time */
Varun Wadekar's avatar
Varun Wadekar committed
69
	for (index = 0U; index < 32U; index += 4U) {
70
71
72
73
74
75
76
77
78
79
80
81
82
		gicd_write_ipriorityr(gicd_base, index,
				GICD_IPRIORITYR_DEF_VAL);
	}

	/*
	 * Invert the bitmask to create a mask for non-secure PPIs and
	 * SGIs. Program the GICD_IGROUPR0 with this bit mask. This write will
	 * update the GICR_IGROUPR0 as well in case we are running on a GICv3
	 * system. This is critical if GICD_CTLR.ARE_NS=1.
	 */
	gicd_write_igroupr(gicd_base, 0, ~sec_ppi_sgi_mask);
}

83
84
85
86
87
/*******************************************************************************
 * Global gic distributor setup which will be done by the primary cpu after a
 * cold boot. It marks out the non secure SPIs, PPIs & SGIs and enables them.
 * It then enables the secure GIC distributor interface.
 ******************************************************************************/
Varun Wadekar's avatar
Varun Wadekar committed
88
static void tegra_gic_distif_setup(uint32_t gicd_base)
89
{
Varun Wadekar's avatar
Varun Wadekar committed
90
	uint32_t index, num_ints, irq_num;
91
92
	uint8_t target_cpus;
	uint32_t val;
93
94
95
96
97
98
99

	/*
	 * Mark out non-secure interrupts. Calculate number of
	 * IGROUPR registers to consider. Will be equal to the
	 * number of IT_LINES
	 */
	num_ints = gicd_read_typer(gicd_base) & IT_LINES_NO_MASK;
Varun Wadekar's avatar
Varun Wadekar committed
100
101
102
103
	num_ints = (num_ints + 1U) << 5;
	for (index = MIN_SPI_ID; index < num_ints; index += 32U) {
		gicd_write_igroupr(gicd_base, index, 0xFFFFFFFFU);
	}
104
105

	/* Setup SPI priorities doing four at a time */
Varun Wadekar's avatar
Varun Wadekar committed
106
	for (index = MIN_SPI_ID; index < num_ints; index += 4U) {
107
108
109
110
		gicd_write_ipriorityr(gicd_base, index,
				GICD_IPRIORITYR_DEF_VAL);
	}

111
	/* Configure SPI secure interrupts now */
Varun Wadekar's avatar
Varun Wadekar committed
112
	if (g_irq_sec_ptr != NULL) {
113

Varun Wadekar's avatar
Varun Wadekar committed
114
115
116
		for (index = 0U; index < g_num_irqs; index++) {
			irq_num = g_irq_sec_ptr[index].irq;
			target_cpus = (uint8_t)g_irq_sec_ptr[index].target_cpus;
117
118
119
120
121
122
123

			if (irq_num >= MIN_SPI_ID) {

				/* Configure as a secure interrupt */
				gicd_clr_igroupr(gicd_base, irq_num);

				/* Configure SPI priority */
Varun Wadekar's avatar
Varun Wadekar committed
124
125
126
				mmio_write_8((uint64_t)gicd_base +
					(uint64_t)GICD_IPRIORITYR +
					(uint64_t)irq_num,
127
128
129
130
131
					GIC_HIGHEST_SEC_PRIORITY &
					GIC_PRI_MASK);

				/* Configure as level triggered */
				val = gicd_read_icfgr(gicd_base, irq_num);
Varun Wadekar's avatar
Varun Wadekar committed
132
				val |= (3U << ((irq_num & 0xFU) << 1U));
133
134
135
136
137
138
139
140
141
142
143
144
				gicd_write_icfgr(gicd_base, irq_num, val);

				/* Route SPI to the target CPUs */
				gicd_set_itargetsr(gicd_base, irq_num,
					target_cpus);

				/* Enable this interrupt */
				gicd_set_isenabler(gicd_base, irq_num);
			}
		}
	}

145
146
147
148
149
150
	/*
	 * Configure the SGI and PPI. This is done in a separated function
	 * because each CPU is responsible for initializing its own private
	 * interrupts.
	 */
	tegra_gic_pcpu_distif_setup(gicd_base);
151
152
153
154
155

	/* enable distributor */
	gicd_write_ctlr(gicd_base, ENABLE_GRP0 | ENABLE_GRP1);
}

Varun Wadekar's avatar
Varun Wadekar committed
156
void tegra_gic_setup(const irq_sec_cfg_t *irq_sec_ptr, uint32_t num_irqs)
157
{
158
159
160
	g_irq_sec_ptr = irq_sec_ptr;
	g_num_irqs = num_irqs;

161
162
163
	tegra_gic_cpuif_setup(TEGRA_GICC_BASE);
	tegra_gic_distif_setup(TEGRA_GICD_BASE);
}
164
165
166
167
168
169
170
171
172
173
174

/*******************************************************************************
 * An ARM processor signals interrupt exceptions through the IRQ and FIQ pins.
 * The interrupt controller knows which pin/line it uses to signal a type of
 * interrupt. This function provides a common implementation of
 * plat_interrupt_type_to_line() in an ARM GIC environment for optional re-use
 * across platforms. It lets the interrupt management framework determine
 * for a type of interrupt and security state, which line should be used in the
 * SCR_EL3 to control its routing to EL3. The interrupt line is represented as
 * the bit position of the IRQ or FIQ bit in the SCR_EL3.
 ******************************************************************************/
Varun Wadekar's avatar
Varun Wadekar committed
175
static uint32_t tegra_gic_interrupt_type_to_line(uint32_t type,
176
177
				uint32_t security_state)
{
Varun Wadekar's avatar
Varun Wadekar committed
178
179
180
	assert((type == INTR_TYPE_S_EL1) ||
	       (type == INTR_TYPE_EL3) ||
	       (type == INTR_TYPE_NS));
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196

	assert(sec_state_is_valid(security_state));

	/*
	 * We ignore the security state parameter under the assumption that
	 * both normal and secure worlds are using ARM GICv2. This parameter
	 * will be used when the secure world starts using GICv3.
	 */
	return gicv2_interrupt_type_to_line(TEGRA_GICC_BASE, type);
}

/*******************************************************************************
 * This function returns the type of the highest priority pending interrupt at
 * the GIC cpu interface. INTR_TYPE_INVAL is returned when there is no
 * interrupt pending.
 ******************************************************************************/
Varun Wadekar's avatar
Varun Wadekar committed
197
static uint32_t tegra_gic_get_pending_interrupt_type(void)
198
199
{
	uint32_t id;
Varun Wadekar's avatar
Varun Wadekar committed
200
201
	uint32_t index;
	uint32_t ret = INTR_TYPE_NS;
202
203
204

	id = gicc_read_hppir(TEGRA_GICC_BASE) & INT_ID_MASK;

205
	/* get the interrupt type */
Varun Wadekar's avatar
Varun Wadekar committed
206
207
208
209
210
211
212
213
214
215
	if (id < 1022U) {
		for (index = 0U; index < g_num_irqs; index++) {
			if (id == g_irq_sec_ptr[index].irq) {
				ret = g_irq_sec_ptr[index].type;
				break;
			}
		}
	} else {
		 if (id == GIC_SPURIOUS_INTERRUPT) {
			ret = INTR_TYPE_INVAL;
216
217
		}
	}
218

Varun Wadekar's avatar
Varun Wadekar committed
219
	return ret;
220
221
222
223
224
225
226
}

/*******************************************************************************
 * This function returns the id of the highest priority pending interrupt at
 * the GIC cpu interface. INTR_ID_UNAVAILABLE is returned when there is no
 * interrupt pending.
 ******************************************************************************/
Varun Wadekar's avatar
Varun Wadekar committed
227
static uint32_t tegra_gic_get_pending_interrupt_id(void)
228
{
Varun Wadekar's avatar
Varun Wadekar committed
229
	uint32_t id, ret;
230
231
232

	id = gicc_read_hppir(TEGRA_GICC_BASE) & INT_ID_MASK;

233
	if (id < 1022U) {
Varun Wadekar's avatar
Varun Wadekar committed
234
		ret = id;
235
236
	} else if (id == 1023U) {
		ret = 0xFFFFFFFFU; /* INTR_ID_UNAVAILABLE */
Varun Wadekar's avatar
Varun Wadekar committed
237
238
239
240
241
242
243
	} else {
		/*
		 * Find out which non-secure interrupt it is under the assumption that
		 * the GICC_CTLR.AckCtl bit is 0.
		 */
		ret = gicc_read_ahppir(TEGRA_GICC_BASE) & INT_ID_MASK;
	}
244

Varun Wadekar's avatar
Varun Wadekar committed
245
	return ret;
246
247
248
249
250
251
}

/*******************************************************************************
 * This functions reads the GIC cpu interface Interrupt Acknowledge register
 * to start handling the pending interrupt. It returns the contents of the IAR.
 ******************************************************************************/
Varun Wadekar's avatar
Varun Wadekar committed
252
static uint32_t tegra_gic_acknowledge_interrupt(void)
253
254
255
256
257
258
259
260
{
	return gicc_read_IAR(TEGRA_GICC_BASE);
}

/*******************************************************************************
 * This functions writes the GIC cpu interface End Of Interrupt register with
 * the passed value to finish handling the active interrupt
 ******************************************************************************/
Varun Wadekar's avatar
Varun Wadekar committed
261
static void tegra_gic_end_of_interrupt(uint32_t id)
262
263
264
265
266
267
268
269
270
{
	gicc_write_EOIR(TEGRA_GICC_BASE, id);
}

/*******************************************************************************
 * This function returns the type of the interrupt id depending upon the group
 * this interrupt has been configured under by the interrupt controller i.e.
 * group0 or group1.
 ******************************************************************************/
Varun Wadekar's avatar
Varun Wadekar committed
271
static uint32_t tegra_gic_get_interrupt_type(uint32_t id)
272
273
{
	uint32_t group;
Varun Wadekar's avatar
Varun Wadekar committed
274
275
	uint32_t index;
	uint32_t ret = INTR_TYPE_NS;
276
277
278

	group = gicd_get_igroupr(TEGRA_GICD_BASE, id);

279
280
	/* get the interrupt type */
	if (group == GRP0) {
Varun Wadekar's avatar
Varun Wadekar committed
281
282
283
284
285
		for (index = 0U; index < g_num_irqs; index++) {
			if (id == g_irq_sec_ptr[index].irq) {
				ret = g_irq_sec_ptr[index].type;
				break;
			}
286
287
288
		}
	}

Varun Wadekar's avatar
Varun Wadekar committed
289
	return ret;
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
}

uint32_t plat_ic_get_pending_interrupt_id(void)
{
	return tegra_gic_get_pending_interrupt_id();
}

uint32_t plat_ic_get_pending_interrupt_type(void)
{
	return tegra_gic_get_pending_interrupt_type();
}

uint32_t plat_ic_acknowledge_interrupt(void)
{
	return tegra_gic_acknowledge_interrupt();
}

uint32_t plat_ic_get_interrupt_type(uint32_t id)
{
	return tegra_gic_get_interrupt_type(id);
}

void plat_ic_end_of_interrupt(uint32_t id)
{
	tegra_gic_end_of_interrupt(id);
}

uint32_t plat_interrupt_type_to_line(uint32_t type,
				uint32_t security_state)
{
	return tegra_gic_interrupt_type_to_line(type, security_state);
}