1caab277bSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only 2021f6537SMarc Zyngier /* 30edc23eaSMarc Zyngier * Copyright (C) 2013-2017 ARM Limited, All Rights Reserved. 4021f6537SMarc Zyngier * Author: Marc Zyngier <marc.zyngier@arm.com> 5021f6537SMarc Zyngier */ 6021f6537SMarc Zyngier 768628bb8SJulien Grall #define pr_fmt(fmt) "GICv3: " fmt 868628bb8SJulien Grall 9ffa7d616STomasz Nowicki #include <linux/acpi.h> 10021f6537SMarc Zyngier #include <linux/cpu.h> 113708d52fSSudeep Holla #include <linux/cpu_pm.h> 12021f6537SMarc Zyngier #include <linux/delay.h> 13021f6537SMarc Zyngier #include <linux/interrupt.h> 14ffa7d616STomasz Nowicki #include <linux/irqdomain.h> 155e279739SChristophe JAILLET #include <linux/kstrtox.h> 16021f6537SMarc Zyngier #include <linux/of.h> 17021f6537SMarc Zyngier #include <linux/of_address.h> 18021f6537SMarc Zyngier #include <linux/of_irq.h> 19021f6537SMarc Zyngier #include <linux/percpu.h> 20101b35f7SJulien Thierry #include <linux/refcount.h> 21021f6537SMarc Zyngier #include <linux/slab.h> 22021f6537SMarc Zyngier 2341a83e06SJoel Porquet #include <linux/irqchip.h> 241839e576SJulien Grall #include <linux/irqchip/arm-gic-common.h> 25021f6537SMarc Zyngier #include <linux/irqchip/arm-gic-v3.h> 26e3825ba1SMarc Zyngier #include <linux/irqchip/irq-partition-percpu.h> 27*35727af2SShanker Donthineni #include <linux/bitfield.h> 28*35727af2SShanker Donthineni #include <linux/bits.h> 29*35727af2SShanker Donthineni #include <linux/arm-smccc.h> 30021f6537SMarc Zyngier 31021f6537SMarc Zyngier #include <asm/cputype.h> 32021f6537SMarc Zyngier #include <asm/exception.h> 33021f6537SMarc Zyngier #include <asm/smp_plat.h> 340b6a3da9SMarc Zyngier #include <asm/virt.h> 35021f6537SMarc Zyngier 36021f6537SMarc Zyngier #include "irq-gic-common.h" 37021f6537SMarc Zyngier 38f32c9266SJulien Thierry #define GICD_INT_NMI_PRI (GICD_INT_DEF_PRI & ~0x80) 39f32c9266SJulien Thierry 409c8114c2SSrinivas Kandagatla #define FLAGS_WORKAROUND_GICR_WAKER_MSM8996 (1ULL << 0) 41d01fd161SMarc Zyngier #define FLAGS_WORKAROUND_CAVIUM_ERRATUM_38539 (1ULL << 1) 429c8114c2SSrinivas Kandagatla 4364b499d8SMarc Zyngier #define GIC_IRQ_TYPE_PARTITION (GIC_IRQ_TYPE_LPI + 1) 4464b499d8SMarc Zyngier 45f5c1434cSMarc Zyngier struct redist_region { 46f5c1434cSMarc Zyngier void __iomem *redist_base; 47f5c1434cSMarc Zyngier phys_addr_t phys_base; 48b70fb7afSTomasz Nowicki bool single_redist; 49f5c1434cSMarc Zyngier }; 50f5c1434cSMarc Zyngier 51021f6537SMarc Zyngier struct gic_chip_data { 52e3825ba1SMarc Zyngier struct fwnode_handle *fwnode; 53*35727af2SShanker Donthineni phys_addr_t dist_phys_base; 54021f6537SMarc Zyngier void __iomem *dist_base; 55f5c1434cSMarc Zyngier struct redist_region *redist_regions; 56f5c1434cSMarc Zyngier struct rdists rdists; 57021f6537SMarc Zyngier struct irq_domain *domain; 58021f6537SMarc Zyngier u64 redist_stride; 59f5c1434cSMarc Zyngier u32 nr_redist_regions; 609c8114c2SSrinivas Kandagatla u64 flags; 61eda0d04aSShanker Donthineni bool has_rss; 621a60e1e6SMarc Zyngier unsigned int ppi_nr; 6352085d3fSMarc Zyngier struct partition_desc **ppi_descs; 64021f6537SMarc Zyngier }; 65021f6537SMarc Zyngier 66*35727af2SShanker Donthineni #define T241_CHIPS_MAX 4 67*35727af2SShanker Donthineni static void __iomem *t241_dist_base_alias[T241_CHIPS_MAX] __read_mostly; 68*35727af2SShanker Donthineni static DEFINE_STATIC_KEY_FALSE(gic_nvidia_t241_erratum); 69*35727af2SShanker Donthineni 70021f6537SMarc Zyngier static struct gic_chip_data gic_data __read_mostly; 71d01d3274SDavidlohr Bueso static DEFINE_STATIC_KEY_TRUE(supports_deactivate_key); 72021f6537SMarc Zyngier 73211bddd2SMarc Zyngier #define GIC_ID_NR (1U << GICD_TYPER_ID_BITS(gic_data.rdists.gicd_typer)) 74c107d613SZenghui Yu #define GIC_LINE_NR min(GICD_TYPER_SPIS(gic_data.rdists.gicd_typer), 1020U) 75211bddd2SMarc Zyngier #define GIC_ESPI_NR GICD_TYPER_ESPIS(gic_data.rdists.gicd_typer) 76211bddd2SMarc Zyngier 77d98d0a99SJulien Thierry /* 78d98d0a99SJulien Thierry * The behaviours of RPR and PMR registers differ depending on the value of 79d98d0a99SJulien Thierry * SCR_EL3.FIQ, and the behaviour of non-secure priority registers of the 80d98d0a99SJulien Thierry * distributor and redistributors depends on whether security is enabled in the 81d98d0a99SJulien Thierry * GIC. 82d98d0a99SJulien Thierry * 83d98d0a99SJulien Thierry * When security is enabled, non-secure priority values from the (re)distributor 84d98d0a99SJulien Thierry * are presented to the GIC CPUIF as follow: 85d98d0a99SJulien Thierry * (GIC_(R)DIST_PRI[irq] >> 1) | 0x80; 86d98d0a99SJulien Thierry * 87d4034114SLorenzo Pieralisi * If SCR_EL3.FIQ == 1, the values written to/read from PMR and RPR at non-secure 88d98d0a99SJulien Thierry * EL1 are subject to a similar operation thus matching the priorities presented 8933678059SAlexandru Elisei * from the (re)distributor when security is enabled. When SCR_EL3.FIQ == 0, 90d4034114SLorenzo Pieralisi * these values are unchanged by the GIC. 91d98d0a99SJulien Thierry * 92d98d0a99SJulien Thierry * see GICv3/GICv4 Architecture Specification (IHI0069D): 93d98d0a99SJulien Thierry * - section 4.8.1 Non-secure accesses to register fields for Secure interrupt 94d98d0a99SJulien Thierry * priorities. 95d98d0a99SJulien Thierry * - Figure 4-7 Secure read of the priority field for a Non-secure Group 1 96d98d0a99SJulien Thierry * interrupt. 97d98d0a99SJulien Thierry */ 98d98d0a99SJulien Thierry static DEFINE_STATIC_KEY_FALSE(supports_pseudo_nmis); 99d98d0a99SJulien Thierry 10033678059SAlexandru Elisei DEFINE_STATIC_KEY_FALSE(gic_nonsecure_priorities); 10133678059SAlexandru Elisei EXPORT_SYMBOL(gic_nonsecure_priorities); 10233678059SAlexandru Elisei 1038d474deaSChen-Yu Tsai /* 1048d474deaSChen-Yu Tsai * When the Non-secure world has access to group 0 interrupts (as a 1058d474deaSChen-Yu Tsai * consequence of SCR_EL3.FIQ == 0), reading the ICC_RPR_EL1 register will 1068d474deaSChen-Yu Tsai * return the Distributor's view of the interrupt priority. 1078d474deaSChen-Yu Tsai * 1088d474deaSChen-Yu Tsai * When GIC security is enabled (GICD_CTLR.DS == 0), the interrupt priority 1098d474deaSChen-Yu Tsai * written by software is moved to the Non-secure range by the Distributor. 1108d474deaSChen-Yu Tsai * 1118d474deaSChen-Yu Tsai * If both are true (which is when gic_nonsecure_priorities gets enabled), 1128d474deaSChen-Yu Tsai * we need to shift down the priority programmed by software to match it 1138d474deaSChen-Yu Tsai * against the value returned by ICC_RPR_EL1. 1148d474deaSChen-Yu Tsai */ 1158d474deaSChen-Yu Tsai #define GICD_INT_RPR_PRI(priority) \ 1168d474deaSChen-Yu Tsai ({ \ 1178d474deaSChen-Yu Tsai u32 __priority = (priority); \ 1188d474deaSChen-Yu Tsai if (static_branch_unlikely(&gic_nonsecure_priorities)) \ 1198d474deaSChen-Yu Tsai __priority = 0x80 | (__priority >> 1); \ 1208d474deaSChen-Yu Tsai \ 1218d474deaSChen-Yu Tsai __priority; \ 1228d474deaSChen-Yu Tsai }) 1238d474deaSChen-Yu Tsai 124101b35f7SJulien Thierry /* ppi_nmi_refs[n] == number of cpus having ppi[n + 16] set as NMI */ 12581a43273SMarc Zyngier static refcount_t *ppi_nmi_refs; 126101b35f7SJulien Thierry 1270e5cb777SMarc Zyngier static struct gic_kvm_info gic_v3_kvm_info __initdata; 128eda0d04aSShanker Donthineni static DEFINE_PER_CPU(bool, has_rss); 1291839e576SJulien Grall 130eda0d04aSShanker Donthineni #define MPIDR_RS(mpidr) (((mpidr) & 0xF0UL) >> 4) 131f5c1434cSMarc Zyngier #define gic_data_rdist() (this_cpu_ptr(gic_data.rdists.rdist)) 132f5c1434cSMarc Zyngier #define gic_data_rdist_rd_base() (gic_data_rdist()->rd_base) 133021f6537SMarc Zyngier #define gic_data_rdist_sgi_base() (gic_data_rdist_rd_base() + SZ_64K) 134021f6537SMarc Zyngier 135021f6537SMarc Zyngier /* Our default, arbitrary priority value. Linux only uses one anyway. */ 136021f6537SMarc Zyngier #define DEFAULT_PMR_VALUE 0xf0 137021f6537SMarc Zyngier 138e91b036eSMarc Zyngier enum gic_intid_range { 13970a29c32SMarc Zyngier SGI_RANGE, 140e91b036eSMarc Zyngier PPI_RANGE, 141e91b036eSMarc Zyngier SPI_RANGE, 1425f51f803SMarc Zyngier EPPI_RANGE, 143211bddd2SMarc Zyngier ESPI_RANGE, 144e91b036eSMarc Zyngier LPI_RANGE, 145e91b036eSMarc Zyngier __INVALID_RANGE__ 146e91b036eSMarc Zyngier }; 147e91b036eSMarc Zyngier 148e91b036eSMarc Zyngier static enum gic_intid_range __get_intid_range(irq_hw_number_t hwirq) 149e91b036eSMarc Zyngier { 150e91b036eSMarc Zyngier switch (hwirq) { 15170a29c32SMarc Zyngier case 0 ... 15: 15270a29c32SMarc Zyngier return SGI_RANGE; 153e91b036eSMarc Zyngier case 16 ... 31: 154e91b036eSMarc Zyngier return PPI_RANGE; 155e91b036eSMarc Zyngier case 32 ... 1019: 156e91b036eSMarc Zyngier return SPI_RANGE; 1575f51f803SMarc Zyngier case EPPI_BASE_INTID ... (EPPI_BASE_INTID + 63): 1585f51f803SMarc Zyngier return EPPI_RANGE; 159211bddd2SMarc Zyngier case ESPI_BASE_INTID ... (ESPI_BASE_INTID + 1023): 160211bddd2SMarc Zyngier return ESPI_RANGE; 161e91b036eSMarc Zyngier case 8192 ... GENMASK(23, 0): 162e91b036eSMarc Zyngier return LPI_RANGE; 163e91b036eSMarc Zyngier default: 164e91b036eSMarc Zyngier return __INVALID_RANGE__; 165e91b036eSMarc Zyngier } 166e91b036eSMarc Zyngier } 167e91b036eSMarc Zyngier 168e91b036eSMarc Zyngier static enum gic_intid_range get_intid_range(struct irq_data *d) 169e91b036eSMarc Zyngier { 170e91b036eSMarc Zyngier return __get_intid_range(d->hwirq); 171e91b036eSMarc Zyngier } 172e91b036eSMarc Zyngier 173021f6537SMarc Zyngier static inline unsigned int gic_irq(struct irq_data *d) 174021f6537SMarc Zyngier { 175021f6537SMarc Zyngier return d->hwirq; 176021f6537SMarc Zyngier } 177021f6537SMarc Zyngier 17870a29c32SMarc Zyngier static inline bool gic_irq_in_rdist(struct irq_data *d) 179021f6537SMarc Zyngier { 18070a29c32SMarc Zyngier switch (get_intid_range(d)) { 18170a29c32SMarc Zyngier case SGI_RANGE: 18270a29c32SMarc Zyngier case PPI_RANGE: 18370a29c32SMarc Zyngier case EPPI_RANGE: 18470a29c32SMarc Zyngier return true; 18570a29c32SMarc Zyngier default: 18670a29c32SMarc Zyngier return false; 18770a29c32SMarc Zyngier } 188021f6537SMarc Zyngier } 189021f6537SMarc Zyngier 190*35727af2SShanker Donthineni static inline void __iomem *gic_dist_base_alias(struct irq_data *d) 191*35727af2SShanker Donthineni { 192*35727af2SShanker Donthineni if (static_branch_unlikely(&gic_nvidia_t241_erratum)) { 193*35727af2SShanker Donthineni irq_hw_number_t hwirq = irqd_to_hwirq(d); 194*35727af2SShanker Donthineni u32 chip; 195*35727af2SShanker Donthineni 196*35727af2SShanker Donthineni /* 197*35727af2SShanker Donthineni * For the erratum T241-FABRIC-4, read accesses to GICD_In{E} 198*35727af2SShanker Donthineni * registers are directed to the chip that owns the SPI. The 199*35727af2SShanker Donthineni * the alias region can also be used for writes to the 200*35727af2SShanker Donthineni * GICD_In{E} except GICD_ICENABLERn. Each chip has support 201*35727af2SShanker Donthineni * for 320 {E}SPIs. Mappings for all 4 chips: 202*35727af2SShanker Donthineni * Chip0 = 32-351 203*35727af2SShanker Donthineni * Chip1 = 352-671 204*35727af2SShanker Donthineni * Chip2 = 672-991 205*35727af2SShanker Donthineni * Chip3 = 4096-4415 206*35727af2SShanker Donthineni */ 207*35727af2SShanker Donthineni switch (__get_intid_range(hwirq)) { 208*35727af2SShanker Donthineni case SPI_RANGE: 209*35727af2SShanker Donthineni chip = (hwirq - 32) / 320; 210*35727af2SShanker Donthineni break; 211*35727af2SShanker Donthineni case ESPI_RANGE: 212*35727af2SShanker Donthineni chip = 3; 213*35727af2SShanker Donthineni break; 214*35727af2SShanker Donthineni default: 215*35727af2SShanker Donthineni unreachable(); 216*35727af2SShanker Donthineni } 217*35727af2SShanker Donthineni return t241_dist_base_alias[chip]; 218*35727af2SShanker Donthineni } 219*35727af2SShanker Donthineni 220*35727af2SShanker Donthineni return gic_data.dist_base; 221*35727af2SShanker Donthineni } 222*35727af2SShanker Donthineni 223021f6537SMarc Zyngier static inline void __iomem *gic_dist_base(struct irq_data *d) 224021f6537SMarc Zyngier { 225e91b036eSMarc Zyngier switch (get_intid_range(d)) { 22670a29c32SMarc Zyngier case SGI_RANGE: 227e91b036eSMarc Zyngier case PPI_RANGE: 2285f51f803SMarc Zyngier case EPPI_RANGE: 229e91b036eSMarc Zyngier /* SGI+PPI -> SGI_base for this CPU */ 230021f6537SMarc Zyngier return gic_data_rdist_sgi_base(); 231021f6537SMarc Zyngier 232e91b036eSMarc Zyngier case SPI_RANGE: 233211bddd2SMarc Zyngier case ESPI_RANGE: 234e91b036eSMarc Zyngier /* SPI -> dist_base */ 235021f6537SMarc Zyngier return gic_data.dist_base; 236021f6537SMarc Zyngier 237e91b036eSMarc Zyngier default: 238021f6537SMarc Zyngier return NULL; 239021f6537SMarc Zyngier } 240e91b036eSMarc Zyngier } 241021f6537SMarc Zyngier 2420df66645SMarc Zyngier static void gic_do_wait_for_rwp(void __iomem *base, u32 bit) 243021f6537SMarc Zyngier { 244021f6537SMarc Zyngier u32 count = 1000000; /* 1s! */ 245021f6537SMarc Zyngier 2460df66645SMarc Zyngier while (readl_relaxed(base + GICD_CTLR) & bit) { 247021f6537SMarc Zyngier count--; 248021f6537SMarc Zyngier if (!count) { 249021f6537SMarc Zyngier pr_err_ratelimited("RWP timeout, gone fishing\n"); 250021f6537SMarc Zyngier return; 251021f6537SMarc Zyngier } 252021f6537SMarc Zyngier cpu_relax(); 253021f6537SMarc Zyngier udelay(1); 2542c542426SDaode Huang } 255021f6537SMarc Zyngier } 256021f6537SMarc Zyngier 257021f6537SMarc Zyngier /* Wait for completion of a distributor change */ 258021f6537SMarc Zyngier static void gic_dist_wait_for_rwp(void) 259021f6537SMarc Zyngier { 2600df66645SMarc Zyngier gic_do_wait_for_rwp(gic_data.dist_base, GICD_CTLR_RWP); 261021f6537SMarc Zyngier } 262021f6537SMarc Zyngier 263021f6537SMarc Zyngier /* Wait for completion of a redistributor change */ 264021f6537SMarc Zyngier static void gic_redist_wait_for_rwp(void) 265021f6537SMarc Zyngier { 2660df66645SMarc Zyngier gic_do_wait_for_rwp(gic_data_rdist_rd_base(), GICR_CTLR_RWP); 267021f6537SMarc Zyngier } 268021f6537SMarc Zyngier 2697936e914SJean-Philippe Brucker #ifdef CONFIG_ARM64 2706d4e11c5SRobert Richter 2716d4e11c5SRobert Richter static u64 __maybe_unused gic_read_iar(void) 2726d4e11c5SRobert Richter { 273a4023f68SSuzuki K Poulose if (cpus_have_const_cap(ARM64_WORKAROUND_CAVIUM_23154)) 2746d4e11c5SRobert Richter return gic_read_iar_cavium_thunderx(); 2756d4e11c5SRobert Richter else 2766d4e11c5SRobert Richter return gic_read_iar_common(); 2776d4e11c5SRobert Richter } 2787936e914SJean-Philippe Brucker #endif 279021f6537SMarc Zyngier 280a2c22510SSudeep Holla static void gic_enable_redist(bool enable) 281021f6537SMarc Zyngier { 282021f6537SMarc Zyngier void __iomem *rbase; 283021f6537SMarc Zyngier u32 count = 1000000; /* 1s! */ 284021f6537SMarc Zyngier u32 val; 285021f6537SMarc Zyngier 2869c8114c2SSrinivas Kandagatla if (gic_data.flags & FLAGS_WORKAROUND_GICR_WAKER_MSM8996) 2879c8114c2SSrinivas Kandagatla return; 2889c8114c2SSrinivas Kandagatla 289021f6537SMarc Zyngier rbase = gic_data_rdist_rd_base(); 290021f6537SMarc Zyngier 291021f6537SMarc Zyngier val = readl_relaxed(rbase + GICR_WAKER); 292a2c22510SSudeep Holla if (enable) 293a2c22510SSudeep Holla /* Wake up this CPU redistributor */ 294021f6537SMarc Zyngier val &= ~GICR_WAKER_ProcessorSleep; 295a2c22510SSudeep Holla else 296a2c22510SSudeep Holla val |= GICR_WAKER_ProcessorSleep; 297021f6537SMarc Zyngier writel_relaxed(val, rbase + GICR_WAKER); 298021f6537SMarc Zyngier 299a2c22510SSudeep Holla if (!enable) { /* Check that GICR_WAKER is writeable */ 300a2c22510SSudeep Holla val = readl_relaxed(rbase + GICR_WAKER); 301a2c22510SSudeep Holla if (!(val & GICR_WAKER_ProcessorSleep)) 302a2c22510SSudeep Holla return; /* No PM support in this redistributor */ 303021f6537SMarc Zyngier } 304a2c22510SSudeep Holla 305d102eb5cSDan Carpenter while (--count) { 306a2c22510SSudeep Holla val = readl_relaxed(rbase + GICR_WAKER); 307cf1d9d11SAndrew Jones if (enable ^ (bool)(val & GICR_WAKER_ChildrenAsleep)) 308a2c22510SSudeep Holla break; 309021f6537SMarc Zyngier cpu_relax(); 310021f6537SMarc Zyngier udelay(1); 3112c542426SDaode Huang } 312a2c22510SSudeep Holla if (!count) 313a2c22510SSudeep Holla pr_err_ratelimited("redistributor failed to %s...\n", 314a2c22510SSudeep Holla enable ? "wakeup" : "sleep"); 315021f6537SMarc Zyngier } 316021f6537SMarc Zyngier 317021f6537SMarc Zyngier /* 318021f6537SMarc Zyngier * Routines to disable, enable, EOI and route interrupts 319021f6537SMarc Zyngier */ 320e91b036eSMarc Zyngier static u32 convert_offset_index(struct irq_data *d, u32 offset, u32 *index) 321e91b036eSMarc Zyngier { 322e91b036eSMarc Zyngier switch (get_intid_range(d)) { 32370a29c32SMarc Zyngier case SGI_RANGE: 324e91b036eSMarc Zyngier case PPI_RANGE: 325e91b036eSMarc Zyngier case SPI_RANGE: 326e91b036eSMarc Zyngier *index = d->hwirq; 327e91b036eSMarc Zyngier return offset; 3285f51f803SMarc Zyngier case EPPI_RANGE: 3295f51f803SMarc Zyngier /* 3305f51f803SMarc Zyngier * Contrary to the ESPI range, the EPPI range is contiguous 3315f51f803SMarc Zyngier * to the PPI range in the registers, so let's adjust the 3325f51f803SMarc Zyngier * displacement accordingly. Consistency is overrated. 3335f51f803SMarc Zyngier */ 3345f51f803SMarc Zyngier *index = d->hwirq - EPPI_BASE_INTID + 32; 3355f51f803SMarc Zyngier return offset; 336211bddd2SMarc Zyngier case ESPI_RANGE: 337211bddd2SMarc Zyngier *index = d->hwirq - ESPI_BASE_INTID; 338211bddd2SMarc Zyngier switch (offset) { 339211bddd2SMarc Zyngier case GICD_ISENABLER: 340211bddd2SMarc Zyngier return GICD_ISENABLERnE; 341211bddd2SMarc Zyngier case GICD_ICENABLER: 342211bddd2SMarc Zyngier return GICD_ICENABLERnE; 343211bddd2SMarc Zyngier case GICD_ISPENDR: 344211bddd2SMarc Zyngier return GICD_ISPENDRnE; 345211bddd2SMarc Zyngier case GICD_ICPENDR: 346211bddd2SMarc Zyngier return GICD_ICPENDRnE; 347211bddd2SMarc Zyngier case GICD_ISACTIVER: 348211bddd2SMarc Zyngier return GICD_ISACTIVERnE; 349211bddd2SMarc Zyngier case GICD_ICACTIVER: 350211bddd2SMarc Zyngier return GICD_ICACTIVERnE; 351211bddd2SMarc Zyngier case GICD_IPRIORITYR: 352211bddd2SMarc Zyngier return GICD_IPRIORITYRnE; 353211bddd2SMarc Zyngier case GICD_ICFGR: 354211bddd2SMarc Zyngier return GICD_ICFGRnE; 355211bddd2SMarc Zyngier case GICD_IROUTER: 356211bddd2SMarc Zyngier return GICD_IROUTERnE; 357211bddd2SMarc Zyngier default: 358211bddd2SMarc Zyngier break; 359211bddd2SMarc Zyngier } 360211bddd2SMarc Zyngier break; 361e91b036eSMarc Zyngier default: 362e91b036eSMarc Zyngier break; 363e91b036eSMarc Zyngier } 364e91b036eSMarc Zyngier 365e91b036eSMarc Zyngier WARN_ON(1); 366e91b036eSMarc Zyngier *index = d->hwirq; 367e91b036eSMarc Zyngier return offset; 368e91b036eSMarc Zyngier } 369e91b036eSMarc Zyngier 370b594c6e2SMarc Zyngier static int gic_peek_irq(struct irq_data *d, u32 offset) 371b594c6e2SMarc Zyngier { 372b594c6e2SMarc Zyngier void __iomem *base; 373e91b036eSMarc Zyngier u32 index, mask; 374e91b036eSMarc Zyngier 375e91b036eSMarc Zyngier offset = convert_offset_index(d, offset, &index); 376e91b036eSMarc Zyngier mask = 1 << (index % 32); 377b594c6e2SMarc Zyngier 378b594c6e2SMarc Zyngier if (gic_irq_in_rdist(d)) 379b594c6e2SMarc Zyngier base = gic_data_rdist_sgi_base(); 380b594c6e2SMarc Zyngier else 381*35727af2SShanker Donthineni base = gic_dist_base_alias(d); 382b594c6e2SMarc Zyngier 383e91b036eSMarc Zyngier return !!(readl_relaxed(base + offset + (index / 32) * 4) & mask); 384b594c6e2SMarc Zyngier } 385b594c6e2SMarc Zyngier 386021f6537SMarc Zyngier static void gic_poke_irq(struct irq_data *d, u32 offset) 387021f6537SMarc Zyngier { 388021f6537SMarc Zyngier void __iomem *base; 389e91b036eSMarc Zyngier u32 index, mask; 390e91b036eSMarc Zyngier 391e91b036eSMarc Zyngier offset = convert_offset_index(d, offset, &index); 392e91b036eSMarc Zyngier mask = 1 << (index % 32); 393021f6537SMarc Zyngier 39463f13483SMarc Zyngier if (gic_irq_in_rdist(d)) 395021f6537SMarc Zyngier base = gic_data_rdist_sgi_base(); 39663f13483SMarc Zyngier else 397021f6537SMarc Zyngier base = gic_data.dist_base; 398021f6537SMarc Zyngier 399e91b036eSMarc Zyngier writel_relaxed(mask, base + offset + (index / 32) * 4); 400021f6537SMarc Zyngier } 401021f6537SMarc Zyngier 402021f6537SMarc Zyngier static void gic_mask_irq(struct irq_data *d) 403021f6537SMarc Zyngier { 404021f6537SMarc Zyngier gic_poke_irq(d, GICD_ICENABLER); 40563f13483SMarc Zyngier if (gic_irq_in_rdist(d)) 40663f13483SMarc Zyngier gic_redist_wait_for_rwp(); 40763f13483SMarc Zyngier else 40863f13483SMarc Zyngier gic_dist_wait_for_rwp(); 409021f6537SMarc Zyngier } 410021f6537SMarc Zyngier 4110b6a3da9SMarc Zyngier static void gic_eoimode1_mask_irq(struct irq_data *d) 4120b6a3da9SMarc Zyngier { 4130b6a3da9SMarc Zyngier gic_mask_irq(d); 414530bf353SMarc Zyngier /* 415530bf353SMarc Zyngier * When masking a forwarded interrupt, make sure it is 416530bf353SMarc Zyngier * deactivated as well. 417530bf353SMarc Zyngier * 418530bf353SMarc Zyngier * This ensures that an interrupt that is getting 419530bf353SMarc Zyngier * disabled/masked will not get "stuck", because there is 420530bf353SMarc Zyngier * noone to deactivate it (guest is being terminated). 421530bf353SMarc Zyngier */ 4224df7f54dSThomas Gleixner if (irqd_is_forwarded_to_vcpu(d)) 423530bf353SMarc Zyngier gic_poke_irq(d, GICD_ICACTIVER); 4240b6a3da9SMarc Zyngier } 4250b6a3da9SMarc Zyngier 426021f6537SMarc Zyngier static void gic_unmask_irq(struct irq_data *d) 427021f6537SMarc Zyngier { 428021f6537SMarc Zyngier gic_poke_irq(d, GICD_ISENABLER); 429021f6537SMarc Zyngier } 430021f6537SMarc Zyngier 431d98d0a99SJulien Thierry static inline bool gic_supports_nmi(void) 432d98d0a99SJulien Thierry { 433d98d0a99SJulien Thierry return IS_ENABLED(CONFIG_ARM64_PSEUDO_NMI) && 434d98d0a99SJulien Thierry static_branch_likely(&supports_pseudo_nmis); 435d98d0a99SJulien Thierry } 436d98d0a99SJulien Thierry 437b594c6e2SMarc Zyngier static int gic_irq_set_irqchip_state(struct irq_data *d, 438b594c6e2SMarc Zyngier enum irqchip_irq_state which, bool val) 439b594c6e2SMarc Zyngier { 440b594c6e2SMarc Zyngier u32 reg; 441b594c6e2SMarc Zyngier 44264b499d8SMarc Zyngier if (d->hwirq >= 8192) /* SGI/PPI/SPI only */ 443b594c6e2SMarc Zyngier return -EINVAL; 444b594c6e2SMarc Zyngier 445b594c6e2SMarc Zyngier switch (which) { 446b594c6e2SMarc Zyngier case IRQCHIP_STATE_PENDING: 447b594c6e2SMarc Zyngier reg = val ? GICD_ISPENDR : GICD_ICPENDR; 448b594c6e2SMarc Zyngier break; 449b594c6e2SMarc Zyngier 450b594c6e2SMarc Zyngier case IRQCHIP_STATE_ACTIVE: 451b594c6e2SMarc Zyngier reg = val ? GICD_ISACTIVER : GICD_ICACTIVER; 452b594c6e2SMarc Zyngier break; 453b594c6e2SMarc Zyngier 454b594c6e2SMarc Zyngier case IRQCHIP_STATE_MASKED: 45563f13483SMarc Zyngier if (val) { 45663f13483SMarc Zyngier gic_mask_irq(d); 45763f13483SMarc Zyngier return 0; 45863f13483SMarc Zyngier } 45963f13483SMarc Zyngier reg = GICD_ISENABLER; 460b594c6e2SMarc Zyngier break; 461b594c6e2SMarc Zyngier 462b594c6e2SMarc Zyngier default: 463b594c6e2SMarc Zyngier return -EINVAL; 464b594c6e2SMarc Zyngier } 465b594c6e2SMarc Zyngier 466b594c6e2SMarc Zyngier gic_poke_irq(d, reg); 467b594c6e2SMarc Zyngier return 0; 468b594c6e2SMarc Zyngier } 469b594c6e2SMarc Zyngier 470b594c6e2SMarc Zyngier static int gic_irq_get_irqchip_state(struct irq_data *d, 471b594c6e2SMarc Zyngier enum irqchip_irq_state which, bool *val) 472b594c6e2SMarc Zyngier { 473211bddd2SMarc Zyngier if (d->hwirq >= 8192) /* PPI/SPI only */ 474b594c6e2SMarc Zyngier return -EINVAL; 475b594c6e2SMarc Zyngier 476b594c6e2SMarc Zyngier switch (which) { 477b594c6e2SMarc Zyngier case IRQCHIP_STATE_PENDING: 478b594c6e2SMarc Zyngier *val = gic_peek_irq(d, GICD_ISPENDR); 479b594c6e2SMarc Zyngier break; 480b594c6e2SMarc Zyngier 481b594c6e2SMarc Zyngier case IRQCHIP_STATE_ACTIVE: 482b594c6e2SMarc Zyngier *val = gic_peek_irq(d, GICD_ISACTIVER); 483b594c6e2SMarc Zyngier break; 484b594c6e2SMarc Zyngier 485b594c6e2SMarc Zyngier case IRQCHIP_STATE_MASKED: 486b594c6e2SMarc Zyngier *val = !gic_peek_irq(d, GICD_ISENABLER); 487b594c6e2SMarc Zyngier break; 488b594c6e2SMarc Zyngier 489b594c6e2SMarc Zyngier default: 490b594c6e2SMarc Zyngier return -EINVAL; 491b594c6e2SMarc Zyngier } 492b594c6e2SMarc Zyngier 493b594c6e2SMarc Zyngier return 0; 494b594c6e2SMarc Zyngier } 495b594c6e2SMarc Zyngier 496101b35f7SJulien Thierry static void gic_irq_set_prio(struct irq_data *d, u8 prio) 497101b35f7SJulien Thierry { 498101b35f7SJulien Thierry void __iomem *base = gic_dist_base(d); 499e91b036eSMarc Zyngier u32 offset, index; 500101b35f7SJulien Thierry 501e91b036eSMarc Zyngier offset = convert_offset_index(d, GICD_IPRIORITYR, &index); 502e91b036eSMarc Zyngier 503e91b036eSMarc Zyngier writeb_relaxed(prio, base + offset + index); 504101b35f7SJulien Thierry } 505101b35f7SJulien Thierry 506bfa80ee9SJames Morse static u32 __gic_get_ppi_index(irq_hw_number_t hwirq) 50781a43273SMarc Zyngier { 508bfa80ee9SJames Morse switch (__get_intid_range(hwirq)) { 50981a43273SMarc Zyngier case PPI_RANGE: 510bfa80ee9SJames Morse return hwirq - 16; 5115f51f803SMarc Zyngier case EPPI_RANGE: 512bfa80ee9SJames Morse return hwirq - EPPI_BASE_INTID + 16; 51381a43273SMarc Zyngier default: 51481a43273SMarc Zyngier unreachable(); 51581a43273SMarc Zyngier } 51681a43273SMarc Zyngier } 51781a43273SMarc Zyngier 518bfa80ee9SJames Morse static u32 gic_get_ppi_index(struct irq_data *d) 519bfa80ee9SJames Morse { 520bfa80ee9SJames Morse return __gic_get_ppi_index(d->hwirq); 521bfa80ee9SJames Morse } 522bfa80ee9SJames Morse 523101b35f7SJulien Thierry static int gic_irq_nmi_setup(struct irq_data *d) 524101b35f7SJulien Thierry { 525101b35f7SJulien Thierry struct irq_desc *desc = irq_to_desc(d->irq); 526101b35f7SJulien Thierry 527101b35f7SJulien Thierry if (!gic_supports_nmi()) 528101b35f7SJulien Thierry return -EINVAL; 529101b35f7SJulien Thierry 530101b35f7SJulien Thierry if (gic_peek_irq(d, GICD_ISENABLER)) { 531101b35f7SJulien Thierry pr_err("Cannot set NMI property of enabled IRQ %u\n", d->irq); 532101b35f7SJulien Thierry return -EINVAL; 533101b35f7SJulien Thierry } 534101b35f7SJulien Thierry 535101b35f7SJulien Thierry /* 536101b35f7SJulien Thierry * A secondary irq_chip should be in charge of LPI request, 537101b35f7SJulien Thierry * it should not be possible to get there 538101b35f7SJulien Thierry */ 539101b35f7SJulien Thierry if (WARN_ON(gic_irq(d) >= 8192)) 540101b35f7SJulien Thierry return -EINVAL; 541101b35f7SJulien Thierry 542101b35f7SJulien Thierry /* desc lock should already be held */ 54381a43273SMarc Zyngier if (gic_irq_in_rdist(d)) { 54481a43273SMarc Zyngier u32 idx = gic_get_ppi_index(d); 54581a43273SMarc Zyngier 546101b35f7SJulien Thierry /* Setting up PPI as NMI, only switch handler for first NMI */ 54781a43273SMarc Zyngier if (!refcount_inc_not_zero(&ppi_nmi_refs[idx])) { 54881a43273SMarc Zyngier refcount_set(&ppi_nmi_refs[idx], 1); 549101b35f7SJulien Thierry desc->handle_irq = handle_percpu_devid_fasteoi_nmi; 550101b35f7SJulien Thierry } 551101b35f7SJulien Thierry } else { 552101b35f7SJulien Thierry desc->handle_irq = handle_fasteoi_nmi; 553101b35f7SJulien Thierry } 554101b35f7SJulien Thierry 555101b35f7SJulien Thierry gic_irq_set_prio(d, GICD_INT_NMI_PRI); 556101b35f7SJulien Thierry 557101b35f7SJulien Thierry return 0; 558101b35f7SJulien Thierry } 559101b35f7SJulien Thierry 560101b35f7SJulien Thierry static void gic_irq_nmi_teardown(struct irq_data *d) 561101b35f7SJulien Thierry { 562101b35f7SJulien Thierry struct irq_desc *desc = irq_to_desc(d->irq); 563101b35f7SJulien Thierry 564101b35f7SJulien Thierry if (WARN_ON(!gic_supports_nmi())) 565101b35f7SJulien Thierry return; 566101b35f7SJulien Thierry 567101b35f7SJulien Thierry if (gic_peek_irq(d, GICD_ISENABLER)) { 568101b35f7SJulien Thierry pr_err("Cannot set NMI property of enabled IRQ %u\n", d->irq); 569101b35f7SJulien Thierry return; 570101b35f7SJulien Thierry } 571101b35f7SJulien Thierry 572101b35f7SJulien Thierry /* 573101b35f7SJulien Thierry * A secondary irq_chip should be in charge of LPI request, 574101b35f7SJulien Thierry * it should not be possible to get there 575101b35f7SJulien Thierry */ 576101b35f7SJulien Thierry if (WARN_ON(gic_irq(d) >= 8192)) 577101b35f7SJulien Thierry return; 578101b35f7SJulien Thierry 579101b35f7SJulien Thierry /* desc lock should already be held */ 58081a43273SMarc Zyngier if (gic_irq_in_rdist(d)) { 58181a43273SMarc Zyngier u32 idx = gic_get_ppi_index(d); 58281a43273SMarc Zyngier 583101b35f7SJulien Thierry /* Tearing down NMI, only switch handler for last NMI */ 58481a43273SMarc Zyngier if (refcount_dec_and_test(&ppi_nmi_refs[idx])) 585101b35f7SJulien Thierry desc->handle_irq = handle_percpu_devid_irq; 586101b35f7SJulien Thierry } else { 587101b35f7SJulien Thierry desc->handle_irq = handle_fasteoi_irq; 588101b35f7SJulien Thierry } 589101b35f7SJulien Thierry 590101b35f7SJulien Thierry gic_irq_set_prio(d, GICD_INT_DEF_PRI); 591101b35f7SJulien Thierry } 592101b35f7SJulien Thierry 593021f6537SMarc Zyngier static void gic_eoi_irq(struct irq_data *d) 594021f6537SMarc Zyngier { 5956efb5092SMark Rutland write_gicreg(gic_irq(d), ICC_EOIR1_EL1); 5966efb5092SMark Rutland isb(); 597021f6537SMarc Zyngier } 598021f6537SMarc Zyngier 5990b6a3da9SMarc Zyngier static void gic_eoimode1_eoi_irq(struct irq_data *d) 6000b6a3da9SMarc Zyngier { 6010b6a3da9SMarc Zyngier /* 602530bf353SMarc Zyngier * No need to deactivate an LPI, or an interrupt that 603530bf353SMarc Zyngier * is is getting forwarded to a vcpu. 6040b6a3da9SMarc Zyngier */ 6054df7f54dSThomas Gleixner if (gic_irq(d) >= 8192 || irqd_is_forwarded_to_vcpu(d)) 6060b6a3da9SMarc Zyngier return; 6070b6a3da9SMarc Zyngier gic_write_dir(gic_irq(d)); 6080b6a3da9SMarc Zyngier } 6090b6a3da9SMarc Zyngier 610021f6537SMarc Zyngier static int gic_set_type(struct irq_data *d, unsigned int type) 611021f6537SMarc Zyngier { 6125f51f803SMarc Zyngier enum gic_intid_range range; 613021f6537SMarc Zyngier unsigned int irq = gic_irq(d); 614021f6537SMarc Zyngier void __iomem *base; 615e91b036eSMarc Zyngier u32 offset, index; 61613d22e2eSMarc Zyngier int ret; 617021f6537SMarc Zyngier 6185f51f803SMarc Zyngier range = get_intid_range(d); 6195f51f803SMarc Zyngier 62064b499d8SMarc Zyngier /* Interrupt configuration for SGIs can't be changed */ 62164b499d8SMarc Zyngier if (range == SGI_RANGE) 62264b499d8SMarc Zyngier return type != IRQ_TYPE_EDGE_RISING ? -EINVAL : 0; 62364b499d8SMarc Zyngier 624fb7e7debSLiviu Dudau /* SPIs have restrictions on the supported types */ 6255f51f803SMarc Zyngier if ((range == SPI_RANGE || range == ESPI_RANGE) && 6265f51f803SMarc Zyngier type != IRQ_TYPE_LEVEL_HIGH && type != IRQ_TYPE_EDGE_RISING) 627021f6537SMarc Zyngier return -EINVAL; 628021f6537SMarc Zyngier 62963f13483SMarc Zyngier if (gic_irq_in_rdist(d)) 630021f6537SMarc Zyngier base = gic_data_rdist_sgi_base(); 63163f13483SMarc Zyngier else 632*35727af2SShanker Donthineni base = gic_dist_base_alias(d); 633021f6537SMarc Zyngier 634e91b036eSMarc Zyngier offset = convert_offset_index(d, GICD_ICFGR, &index); 63513d22e2eSMarc Zyngier 63663f13483SMarc Zyngier ret = gic_configure_irq(index, type, base + offset, NULL); 6375f51f803SMarc Zyngier if (ret && (range == PPI_RANGE || range == EPPI_RANGE)) { 63813d22e2eSMarc Zyngier /* Misconfigured PPIs are usually not fatal */ 6395f51f803SMarc Zyngier pr_warn("GIC: PPI INTID%d is secure or misconfigured\n", irq); 64013d22e2eSMarc Zyngier ret = 0; 64113d22e2eSMarc Zyngier } 64213d22e2eSMarc Zyngier 64313d22e2eSMarc Zyngier return ret; 644021f6537SMarc Zyngier } 645021f6537SMarc Zyngier 646530bf353SMarc Zyngier static int gic_irq_set_vcpu_affinity(struct irq_data *d, void *vcpu) 647530bf353SMarc Zyngier { 64864b499d8SMarc Zyngier if (get_intid_range(d) == SGI_RANGE) 64964b499d8SMarc Zyngier return -EINVAL; 65064b499d8SMarc Zyngier 6514df7f54dSThomas Gleixner if (vcpu) 6524df7f54dSThomas Gleixner irqd_set_forwarded_to_vcpu(d); 6534df7f54dSThomas Gleixner else 6544df7f54dSThomas Gleixner irqd_clr_forwarded_to_vcpu(d); 655530bf353SMarc Zyngier return 0; 656530bf353SMarc Zyngier } 657530bf353SMarc Zyngier 658f6c86a41SJean-Philippe Brucker static u64 gic_mpidr_to_affinity(unsigned long mpidr) 659021f6537SMarc Zyngier { 660021f6537SMarc Zyngier u64 aff; 661021f6537SMarc Zyngier 662f6c86a41SJean-Philippe Brucker aff = ((u64)MPIDR_AFFINITY_LEVEL(mpidr, 3) << 32 | 663021f6537SMarc Zyngier MPIDR_AFFINITY_LEVEL(mpidr, 2) << 16 | 664021f6537SMarc Zyngier MPIDR_AFFINITY_LEVEL(mpidr, 1) << 8 | 665021f6537SMarc Zyngier MPIDR_AFFINITY_LEVEL(mpidr, 0)); 666021f6537SMarc Zyngier 667021f6537SMarc Zyngier return aff; 668021f6537SMarc Zyngier } 669021f6537SMarc Zyngier 670f32c9266SJulien Thierry static void gic_deactivate_unhandled(u32 irqnr) 671f32c9266SJulien Thierry { 672f32c9266SJulien Thierry if (static_branch_likely(&supports_deactivate_key)) { 673f32c9266SJulien Thierry if (irqnr < 8192) 674f32c9266SJulien Thierry gic_write_dir(irqnr); 675f32c9266SJulien Thierry } else { 6766efb5092SMark Rutland write_gicreg(irqnr, ICC_EOIR1_EL1); 6776efb5092SMark Rutland isb(); 678f32c9266SJulien Thierry } 679f32c9266SJulien Thierry } 680f32c9266SJulien Thierry 681f32c9266SJulien Thierry /* 6826efb5092SMark Rutland * Follow a read of the IAR with any HW maintenance that needs to happen prior 6836efb5092SMark Rutland * to invoking the relevant IRQ handler. We must do two things: 6846efb5092SMark Rutland * 6856efb5092SMark Rutland * (1) Ensure instruction ordering between a read of IAR and subsequent 6866efb5092SMark Rutland * instructions in the IRQ handler using an ISB. 6876efb5092SMark Rutland * 6886efb5092SMark Rutland * It is possible for the IAR to report an IRQ which was signalled *after* 6896efb5092SMark Rutland * the CPU took an IRQ exception as multiple interrupts can race to be 6906efb5092SMark Rutland * recognized by the GIC, earlier interrupts could be withdrawn, and/or 6916efb5092SMark Rutland * later interrupts could be prioritized by the GIC. 6926efb5092SMark Rutland * 6936efb5092SMark Rutland * For devices which are tightly coupled to the CPU, such as PMUs, a 6946efb5092SMark Rutland * context synchronization event is necessary to ensure that system 6956efb5092SMark Rutland * register state is not stale, as these may have been indirectly written 6966efb5092SMark Rutland * *after* exception entry. 6976efb5092SMark Rutland * 6986efb5092SMark Rutland * (2) Deactivate the interrupt when EOI mode 1 is in use. 699f32c9266SJulien Thierry */ 7006efb5092SMark Rutland static inline void gic_complete_ack(u32 irqnr) 7016efb5092SMark Rutland { 7026efb5092SMark Rutland if (static_branch_likely(&supports_deactivate_key)) 7036efb5092SMark Rutland write_gicreg(irqnr, ICC_EOIR1_EL1); 70417ce302fSJulien Thierry 7056efb5092SMark Rutland isb(); 7066efb5092SMark Rutland } 7076efb5092SMark Rutland 708614ab80cSMark Rutland static bool gic_rpr_is_nmi_prio(void) 709f32c9266SJulien Thierry { 710614ab80cSMark Rutland if (!gic_supports_nmi()) 711614ab80cSMark Rutland return false; 712f32c9266SJulien Thierry 713614ab80cSMark Rutland return unlikely(gic_read_rpr() == GICD_INT_RPR_PRI(GICD_INT_NMI_PRI)); 714614ab80cSMark Rutland } 715614ab80cSMark Rutland 716614ab80cSMark Rutland static bool gic_irqnr_is_special(u32 irqnr) 717614ab80cSMark Rutland { 718614ab80cSMark Rutland return irqnr >= 1020 && irqnr <= 1023; 719614ab80cSMark Rutland } 720614ab80cSMark Rutland 721614ab80cSMark Rutland static void __gic_handle_irq(u32 irqnr, struct pt_regs *regs) 722614ab80cSMark Rutland { 723614ab80cSMark Rutland if (gic_irqnr_is_special(irqnr)) 724614ab80cSMark Rutland return; 725f32c9266SJulien Thierry 7266efb5092SMark Rutland gic_complete_ack(irqnr); 727adf14453SMark Rutland 728614ab80cSMark Rutland if (generic_handle_domain_irq(gic_data.domain, irqnr)) { 729614ab80cSMark Rutland WARN_ONCE(true, "Unexpected interrupt (irqnr %u)\n", irqnr); 730f32c9266SJulien Thierry gic_deactivate_unhandled(irqnr); 731614ab80cSMark Rutland } 732614ab80cSMark Rutland } 73317ce302fSJulien Thierry 734614ab80cSMark Rutland static void __gic_handle_nmi(u32 irqnr, struct pt_regs *regs) 735614ab80cSMark Rutland { 736614ab80cSMark Rutland if (gic_irqnr_is_special(irqnr)) 737614ab80cSMark Rutland return; 738614ab80cSMark Rutland 739614ab80cSMark Rutland gic_complete_ack(irqnr); 740614ab80cSMark Rutland 741614ab80cSMark Rutland if (generic_handle_domain_nmi(gic_data.domain, irqnr)) { 742614ab80cSMark Rutland WARN_ONCE(true, "Unexpected pseudo-NMI (irqnr %u)\n", irqnr); 743614ab80cSMark Rutland gic_deactivate_unhandled(irqnr); 744614ab80cSMark Rutland } 745614ab80cSMark Rutland } 746614ab80cSMark Rutland 747614ab80cSMark Rutland /* 748614ab80cSMark Rutland * An exception has been taken from a context with IRQs enabled, and this could 749614ab80cSMark Rutland * be an IRQ or an NMI. 750614ab80cSMark Rutland * 751614ab80cSMark Rutland * The entry code called us with DAIF.IF set to keep NMIs masked. We must clear 752614ab80cSMark Rutland * DAIF.IF (and update ICC_PMR_EL1 to mask regular IRQs) prior to returning, 753614ab80cSMark Rutland * after handling any NMI but before handling any IRQ. 754614ab80cSMark Rutland * 755614ab80cSMark Rutland * The entry code has performed IRQ entry, and if an NMI is detected we must 756614ab80cSMark Rutland * perform NMI entry/exit around invoking the handler. 757614ab80cSMark Rutland */ 758614ab80cSMark Rutland static void __gic_handle_irq_from_irqson(struct pt_regs *regs) 759614ab80cSMark Rutland { 760614ab80cSMark Rutland bool is_nmi; 761614ab80cSMark Rutland u32 irqnr; 762614ab80cSMark Rutland 763614ab80cSMark Rutland irqnr = gic_read_iar(); 764614ab80cSMark Rutland 765614ab80cSMark Rutland is_nmi = gic_rpr_is_nmi_prio(); 766614ab80cSMark Rutland 767614ab80cSMark Rutland if (is_nmi) { 768614ab80cSMark Rutland nmi_enter(); 769614ab80cSMark Rutland __gic_handle_nmi(irqnr, regs); 77017ce302fSJulien Thierry nmi_exit(); 771f32c9266SJulien Thierry } 772f32c9266SJulien Thierry 773614ab80cSMark Rutland if (gic_prio_masking_enabled()) { 774614ab80cSMark Rutland gic_pmr_mask_irqs(); 775614ab80cSMark Rutland gic_arch_enable_irqs(); 776614ab80cSMark Rutland } 777382e6e17SMarc Zyngier 778614ab80cSMark Rutland if (!is_nmi) 779614ab80cSMark Rutland __gic_handle_irq(irqnr, regs); 780614ab80cSMark Rutland } 781614ab80cSMark Rutland 782614ab80cSMark Rutland /* 783614ab80cSMark Rutland * An exception has been taken from a context with IRQs disabled, which can only 784614ab80cSMark Rutland * be an NMI. 785614ab80cSMark Rutland * 786614ab80cSMark Rutland * The entry code called us with DAIF.IF set to keep NMIs masked. We must leave 787614ab80cSMark Rutland * DAIF.IF (and ICC_PMR_EL1) unchanged. 788614ab80cSMark Rutland * 789614ab80cSMark Rutland * The entry code has performed NMI entry. 790614ab80cSMark Rutland */ 791614ab80cSMark Rutland static void __gic_handle_irq_from_irqsoff(struct pt_regs *regs) 792614ab80cSMark Rutland { 793382e6e17SMarc Zyngier u64 pmr; 794614ab80cSMark Rutland u32 irqnr; 795382e6e17SMarc Zyngier 796382e6e17SMarc Zyngier /* 797382e6e17SMarc Zyngier * We were in a context with IRQs disabled. However, the 798382e6e17SMarc Zyngier * entry code has set PMR to a value that allows any 799382e6e17SMarc Zyngier * interrupt to be acknowledged, and not just NMIs. This can 800382e6e17SMarc Zyngier * lead to surprising effects if the NMI has been retired in 801382e6e17SMarc Zyngier * the meantime, and that there is an IRQ pending. The IRQ 802382e6e17SMarc Zyngier * would then be taken in NMI context, something that nobody 803382e6e17SMarc Zyngier * wants to debug twice. 804382e6e17SMarc Zyngier * 805382e6e17SMarc Zyngier * Until we sort this, drop PMR again to a level that will 806382e6e17SMarc Zyngier * actually only allow NMIs before reading IAR, and then 807382e6e17SMarc Zyngier * restore it to what it was. 808382e6e17SMarc Zyngier */ 809382e6e17SMarc Zyngier pmr = gic_read_pmr(); 810382e6e17SMarc Zyngier gic_pmr_mask_irqs(); 811382e6e17SMarc Zyngier isb(); 812614ab80cSMark Rutland irqnr = gic_read_iar(); 813382e6e17SMarc Zyngier gic_write_pmr(pmr); 814382e6e17SMarc Zyngier 815614ab80cSMark Rutland __gic_handle_nmi(irqnr, regs); 816382e6e17SMarc Zyngier } 817382e6e17SMarc Zyngier 818021f6537SMarc Zyngier static asmlinkage void __exception_irq_entry gic_handle_irq(struct pt_regs *regs) 819021f6537SMarc Zyngier { 820614ab80cSMark Rutland if (unlikely(gic_supports_nmi() && !interrupts_enabled(regs))) 821614ab80cSMark Rutland __gic_handle_irq_from_irqsoff(regs); 82239a06b67SWill Deacon else 823614ab80cSMark Rutland __gic_handle_irq_from_irqson(regs); 824021f6537SMarc Zyngier } 825021f6537SMarc Zyngier 826b5cf6073SJulien Thierry static u32 gic_get_pribits(void) 827b5cf6073SJulien Thierry { 828b5cf6073SJulien Thierry u32 pribits; 829b5cf6073SJulien Thierry 830b5cf6073SJulien Thierry pribits = gic_read_ctlr(); 831b5cf6073SJulien Thierry pribits &= ICC_CTLR_EL1_PRI_BITS_MASK; 832b5cf6073SJulien Thierry pribits >>= ICC_CTLR_EL1_PRI_BITS_SHIFT; 833b5cf6073SJulien Thierry pribits++; 834b5cf6073SJulien Thierry 835b5cf6073SJulien Thierry return pribits; 836b5cf6073SJulien Thierry } 837b5cf6073SJulien Thierry 838b5cf6073SJulien Thierry static bool gic_has_group0(void) 839b5cf6073SJulien Thierry { 840b5cf6073SJulien Thierry u32 val; 841e7932188SJulien Thierry u32 old_pmr; 842e7932188SJulien Thierry 843e7932188SJulien Thierry old_pmr = gic_read_pmr(); 844b5cf6073SJulien Thierry 845b5cf6073SJulien Thierry /* 846b5cf6073SJulien Thierry * Let's find out if Group0 is under control of EL3 or not by 847b5cf6073SJulien Thierry * setting the highest possible, non-zero priority in PMR. 848b5cf6073SJulien Thierry * 849b5cf6073SJulien Thierry * If SCR_EL3.FIQ is set, the priority gets shifted down in 850b5cf6073SJulien Thierry * order for the CPU interface to set bit 7, and keep the 851b5cf6073SJulien Thierry * actual priority in the non-secure range. In the process, it 852b5cf6073SJulien Thierry * looses the least significant bit and the actual priority 853b5cf6073SJulien Thierry * becomes 0x80. Reading it back returns 0, indicating that 854b5cf6073SJulien Thierry * we're don't have access to Group0. 855b5cf6073SJulien Thierry */ 856b5cf6073SJulien Thierry gic_write_pmr(BIT(8 - gic_get_pribits())); 857b5cf6073SJulien Thierry val = gic_read_pmr(); 858b5cf6073SJulien Thierry 859e7932188SJulien Thierry gic_write_pmr(old_pmr); 860e7932188SJulien Thierry 861b5cf6073SJulien Thierry return val != 0; 862b5cf6073SJulien Thierry } 863b5cf6073SJulien Thierry 864021f6537SMarc Zyngier static void __init gic_dist_init(void) 865021f6537SMarc Zyngier { 866021f6537SMarc Zyngier unsigned int i; 867021f6537SMarc Zyngier u64 affinity; 868021f6537SMarc Zyngier void __iomem *base = gic_data.dist_base; 8690b04758bSMarc Zyngier u32 val; 870021f6537SMarc Zyngier 871021f6537SMarc Zyngier /* Disable the distributor */ 872021f6537SMarc Zyngier writel_relaxed(0, base + GICD_CTLR); 873021f6537SMarc Zyngier gic_dist_wait_for_rwp(); 874021f6537SMarc Zyngier 8757c9b9730SMarc Zyngier /* 8767c9b9730SMarc Zyngier * Configure SPIs as non-secure Group-1. This will only matter 8777c9b9730SMarc Zyngier * if the GIC only has a single security state. This will not 8787c9b9730SMarc Zyngier * do the right thing if the kernel is running in secure mode, 8797c9b9730SMarc Zyngier * but that's not the intended use case anyway. 8807c9b9730SMarc Zyngier */ 881211bddd2SMarc Zyngier for (i = 32; i < GIC_LINE_NR; i += 32) 8827c9b9730SMarc Zyngier writel_relaxed(~0, base + GICD_IGROUPR + i / 8); 8837c9b9730SMarc Zyngier 884211bddd2SMarc Zyngier /* Extended SPI range, not handled by the GICv2/GICv3 common code */ 885211bddd2SMarc Zyngier for (i = 0; i < GIC_ESPI_NR; i += 32) { 886211bddd2SMarc Zyngier writel_relaxed(~0U, base + GICD_ICENABLERnE + i / 8); 887211bddd2SMarc Zyngier writel_relaxed(~0U, base + GICD_ICACTIVERnE + i / 8); 888211bddd2SMarc Zyngier } 889211bddd2SMarc Zyngier 890211bddd2SMarc Zyngier for (i = 0; i < GIC_ESPI_NR; i += 32) 891211bddd2SMarc Zyngier writel_relaxed(~0U, base + GICD_IGROUPRnE + i / 8); 892211bddd2SMarc Zyngier 893211bddd2SMarc Zyngier for (i = 0; i < GIC_ESPI_NR; i += 16) 894211bddd2SMarc Zyngier writel_relaxed(0, base + GICD_ICFGRnE + i / 4); 895211bddd2SMarc Zyngier 896211bddd2SMarc Zyngier for (i = 0; i < GIC_ESPI_NR; i += 4) 897211bddd2SMarc Zyngier writel_relaxed(GICD_INT_DEF_PRI_X4, base + GICD_IPRIORITYRnE + i); 898211bddd2SMarc Zyngier 89963f13483SMarc Zyngier /* Now do the common stuff */ 90063f13483SMarc Zyngier gic_dist_config(base, GIC_LINE_NR, NULL); 901021f6537SMarc Zyngier 9020b04758bSMarc Zyngier val = GICD_CTLR_ARE_NS | GICD_CTLR_ENABLE_G1A | GICD_CTLR_ENABLE_G1; 9030b04758bSMarc Zyngier if (gic_data.rdists.gicd_typer2 & GICD_TYPER2_nASSGIcap) { 9040b04758bSMarc Zyngier pr_info("Enabling SGIs without active state\n"); 9050b04758bSMarc Zyngier val |= GICD_CTLR_nASSGIreq; 9060b04758bSMarc Zyngier } 9070b04758bSMarc Zyngier 90863f13483SMarc Zyngier /* Enable distributor with ARE, Group1, and wait for it to drain */ 9090b04758bSMarc Zyngier writel_relaxed(val, base + GICD_CTLR); 91063f13483SMarc Zyngier gic_dist_wait_for_rwp(); 911021f6537SMarc Zyngier 912021f6537SMarc Zyngier /* 913021f6537SMarc Zyngier * Set all global interrupts to the boot CPU only. ARE must be 914021f6537SMarc Zyngier * enabled. 915021f6537SMarc Zyngier */ 916021f6537SMarc Zyngier affinity = gic_mpidr_to_affinity(cpu_logical_map(smp_processor_id())); 917211bddd2SMarc Zyngier for (i = 32; i < GIC_LINE_NR; i++) 91872c97126SJean-Philippe Brucker gic_write_irouter(affinity, base + GICD_IROUTER + i * 8); 919211bddd2SMarc Zyngier 920211bddd2SMarc Zyngier for (i = 0; i < GIC_ESPI_NR; i++) 921211bddd2SMarc Zyngier gic_write_irouter(affinity, base + GICD_IROUTERnE + i * 8); 922021f6537SMarc Zyngier } 923021f6537SMarc Zyngier 9240d94ded2SMarc Zyngier static int gic_iterate_rdists(int (*fn)(struct redist_region *, void __iomem *)) 925021f6537SMarc Zyngier { 9260d94ded2SMarc Zyngier int ret = -ENODEV; 927021f6537SMarc Zyngier int i; 928021f6537SMarc Zyngier 929f5c1434cSMarc Zyngier for (i = 0; i < gic_data.nr_redist_regions; i++) { 930f5c1434cSMarc Zyngier void __iomem *ptr = gic_data.redist_regions[i].redist_base; 9310d94ded2SMarc Zyngier u64 typer; 932021f6537SMarc Zyngier u32 reg; 933021f6537SMarc Zyngier 934021f6537SMarc Zyngier reg = readl_relaxed(ptr + GICR_PIDR2) & GIC_PIDR2_ARCH_MASK; 935021f6537SMarc Zyngier if (reg != GIC_PIDR2_ARCH_GICv3 && 936021f6537SMarc Zyngier reg != GIC_PIDR2_ARCH_GICv4) { /* We're in trouble... */ 937021f6537SMarc Zyngier pr_warn("No redistributor present @%p\n", ptr); 938021f6537SMarc Zyngier break; 939021f6537SMarc Zyngier } 940021f6537SMarc Zyngier 941021f6537SMarc Zyngier do { 94272c97126SJean-Philippe Brucker typer = gic_read_typer(ptr + GICR_TYPER); 9430d94ded2SMarc Zyngier ret = fn(gic_data.redist_regions + i, ptr); 9440d94ded2SMarc Zyngier if (!ret) 945021f6537SMarc Zyngier return 0; 946021f6537SMarc Zyngier 947b70fb7afSTomasz Nowicki if (gic_data.redist_regions[i].single_redist) 948b70fb7afSTomasz Nowicki break; 949b70fb7afSTomasz Nowicki 950021f6537SMarc Zyngier if (gic_data.redist_stride) { 951021f6537SMarc Zyngier ptr += gic_data.redist_stride; 952021f6537SMarc Zyngier } else { 953021f6537SMarc Zyngier ptr += SZ_64K * 2; /* Skip RD_base + SGI_base */ 954021f6537SMarc Zyngier if (typer & GICR_TYPER_VLPIS) 955021f6537SMarc Zyngier ptr += SZ_64K * 2; /* Skip VLPI_base + reserved page */ 956021f6537SMarc Zyngier } 957021f6537SMarc Zyngier } while (!(typer & GICR_TYPER_LAST)); 958021f6537SMarc Zyngier } 959021f6537SMarc Zyngier 9600d94ded2SMarc Zyngier return ret ? -ENODEV : 0; 9610d94ded2SMarc Zyngier } 9620d94ded2SMarc Zyngier 9630d94ded2SMarc Zyngier static int __gic_populate_rdist(struct redist_region *region, void __iomem *ptr) 9640d94ded2SMarc Zyngier { 9650d94ded2SMarc Zyngier unsigned long mpidr = cpu_logical_map(smp_processor_id()); 9660d94ded2SMarc Zyngier u64 typer; 9670d94ded2SMarc Zyngier u32 aff; 9680d94ded2SMarc Zyngier 9690d94ded2SMarc Zyngier /* 9700d94ded2SMarc Zyngier * Convert affinity to a 32bit value that can be matched to 9710d94ded2SMarc Zyngier * GICR_TYPER bits [63:32]. 9720d94ded2SMarc Zyngier */ 9730d94ded2SMarc Zyngier aff = (MPIDR_AFFINITY_LEVEL(mpidr, 3) << 24 | 9740d94ded2SMarc Zyngier MPIDR_AFFINITY_LEVEL(mpidr, 2) << 16 | 9750d94ded2SMarc Zyngier MPIDR_AFFINITY_LEVEL(mpidr, 1) << 8 | 9760d94ded2SMarc Zyngier MPIDR_AFFINITY_LEVEL(mpidr, 0)); 9770d94ded2SMarc Zyngier 9780d94ded2SMarc Zyngier typer = gic_read_typer(ptr + GICR_TYPER); 9790d94ded2SMarc Zyngier if ((typer >> 32) == aff) { 9800d94ded2SMarc Zyngier u64 offset = ptr - region->redist_base; 9819058a4e9SMarc Zyngier raw_spin_lock_init(&gic_data_rdist()->rd_lock); 9820d94ded2SMarc Zyngier gic_data_rdist_rd_base() = ptr; 9830d94ded2SMarc Zyngier gic_data_rdist()->phys_base = region->phys_base + offset; 9840d94ded2SMarc Zyngier 9850d94ded2SMarc Zyngier pr_info("CPU%d: found redistributor %lx region %d:%pa\n", 9860d94ded2SMarc Zyngier smp_processor_id(), mpidr, 9870d94ded2SMarc Zyngier (int)(region - gic_data.redist_regions), 9880d94ded2SMarc Zyngier &gic_data_rdist()->phys_base); 9890d94ded2SMarc Zyngier return 0; 9900d94ded2SMarc Zyngier } 9910d94ded2SMarc Zyngier 9920d94ded2SMarc Zyngier /* Try next one */ 9930d94ded2SMarc Zyngier return 1; 9940d94ded2SMarc Zyngier } 9950d94ded2SMarc Zyngier 9960d94ded2SMarc Zyngier static int gic_populate_rdist(void) 9970d94ded2SMarc Zyngier { 9980d94ded2SMarc Zyngier if (gic_iterate_rdists(__gic_populate_rdist) == 0) 9990d94ded2SMarc Zyngier return 0; 10000d94ded2SMarc Zyngier 1001021f6537SMarc Zyngier /* We couldn't even deal with ourselves... */ 1002f6c86a41SJean-Philippe Brucker WARN(true, "CPU%d: mpidr %lx has no re-distributor!\n", 10030d94ded2SMarc Zyngier smp_processor_id(), 10040d94ded2SMarc Zyngier (unsigned long)cpu_logical_map(smp_processor_id())); 1005021f6537SMarc Zyngier return -ENODEV; 1006021f6537SMarc Zyngier } 1007021f6537SMarc Zyngier 10081a60e1e6SMarc Zyngier static int __gic_update_rdist_properties(struct redist_region *region, 10090edc23eaSMarc Zyngier void __iomem *ptr) 10100edc23eaSMarc Zyngier { 10110edc23eaSMarc Zyngier u64 typer = gic_read_typer(ptr + GICR_TYPER); 1012a837ed36SMarc Zyngier u32 ctlr = readl_relaxed(ptr + GICR_CTLR); 1013b25319d2SMarc Zyngier 10144d968297SZhiyuan Dai /* Boot-time cleanup */ 101579a7f77bSMarc Zyngier if ((typer & GICR_TYPER_VLPIS) && (typer & GICR_TYPER_RVPEID)) { 101679a7f77bSMarc Zyngier u64 val; 101779a7f77bSMarc Zyngier 101879a7f77bSMarc Zyngier /* Deactivate any present vPE */ 101979a7f77bSMarc Zyngier val = gicr_read_vpendbaser(ptr + SZ_128K + GICR_VPENDBASER); 102079a7f77bSMarc Zyngier if (val & GICR_VPENDBASER_Valid) 102179a7f77bSMarc Zyngier gicr_write_vpendbaser(GICR_VPENDBASER_PendingLast, 102279a7f77bSMarc Zyngier ptr + SZ_128K + GICR_VPENDBASER); 102379a7f77bSMarc Zyngier 102479a7f77bSMarc Zyngier /* Mark the VPE table as invalid */ 102579a7f77bSMarc Zyngier val = gicr_read_vpropbaser(ptr + SZ_128K + GICR_VPROPBASER); 102679a7f77bSMarc Zyngier val &= ~GICR_VPROPBASER_4_1_VALID; 102779a7f77bSMarc Zyngier gicr_write_vpropbaser(val, ptr + SZ_128K + GICR_VPROPBASER); 102879a7f77bSMarc Zyngier } 102979a7f77bSMarc Zyngier 10300edc23eaSMarc Zyngier gic_data.rdists.has_vlpis &= !!(typer & GICR_TYPER_VLPIS); 1031b25319d2SMarc Zyngier 1032a837ed36SMarc Zyngier /* 1033a837ed36SMarc Zyngier * TYPER.RVPEID implies some form of DirectLPI, no matter what the 1034a837ed36SMarc Zyngier * doc says... :-/ And CTLR.IR implies another subset of DirectLPI 1035a837ed36SMarc Zyngier * that the ITS driver can make use of for LPIs (and not VLPIs). 1036a837ed36SMarc Zyngier * 1037a837ed36SMarc Zyngier * These are 3 different ways to express the same thing, depending 1038a837ed36SMarc Zyngier * on the revision of the architecture and its relaxations over 1039a837ed36SMarc Zyngier * time. Just group them under the 'direct_lpi' banner. 1040a837ed36SMarc Zyngier */ 1041b25319d2SMarc Zyngier gic_data.rdists.has_rvpeid &= !!(typer & GICR_TYPER_RVPEID); 1042b25319d2SMarc Zyngier gic_data.rdists.has_direct_lpi &= (!!(typer & GICR_TYPER_DirectLPIS) | 1043a837ed36SMarc Zyngier !!(ctlr & GICR_CTLR_IR) | 1044b25319d2SMarc Zyngier gic_data.rdists.has_rvpeid); 104596806229SMarc Zyngier gic_data.rdists.has_vpend_valid_dirty &= !!(typer & GICR_TYPER_DIRTY); 1046b25319d2SMarc Zyngier 1047b25319d2SMarc Zyngier /* Detect non-sensical configurations */ 1048b25319d2SMarc Zyngier if (WARN_ON_ONCE(gic_data.rdists.has_rvpeid && !gic_data.rdists.has_vlpis)) { 1049b25319d2SMarc Zyngier gic_data.rdists.has_direct_lpi = false; 1050b25319d2SMarc Zyngier gic_data.rdists.has_vlpis = false; 1051b25319d2SMarc Zyngier gic_data.rdists.has_rvpeid = false; 1052b25319d2SMarc Zyngier } 1053b25319d2SMarc Zyngier 10545f51f803SMarc Zyngier gic_data.ppi_nr = min(GICR_TYPER_NR_PPIS(typer), gic_data.ppi_nr); 10550edc23eaSMarc Zyngier 10560edc23eaSMarc Zyngier return 1; 10570edc23eaSMarc Zyngier } 10580edc23eaSMarc Zyngier 10591a60e1e6SMarc Zyngier static void gic_update_rdist_properties(void) 10600edc23eaSMarc Zyngier { 10611a60e1e6SMarc Zyngier gic_data.ppi_nr = UINT_MAX; 10621a60e1e6SMarc Zyngier gic_iterate_rdists(__gic_update_rdist_properties); 10631a60e1e6SMarc Zyngier if (WARN_ON(gic_data.ppi_nr == UINT_MAX)) 10641a60e1e6SMarc Zyngier gic_data.ppi_nr = 0; 1065a837ed36SMarc Zyngier pr_info("GICv3 features: %d PPIs%s%s\n", 1066a837ed36SMarc Zyngier gic_data.ppi_nr, 1067a837ed36SMarc Zyngier gic_data.has_rss ? ", RSS" : "", 1068a837ed36SMarc Zyngier gic_data.rdists.has_direct_lpi ? ", DirectLPI" : ""); 1069a837ed36SMarc Zyngier 107096806229SMarc Zyngier if (gic_data.rdists.has_vlpis) 107196806229SMarc Zyngier pr_info("GICv4 features: %s%s%s\n", 107296806229SMarc Zyngier gic_data.rdists.has_direct_lpi ? "DirectLPI " : "", 107396806229SMarc Zyngier gic_data.rdists.has_rvpeid ? "RVPEID " : "", 107496806229SMarc Zyngier gic_data.rdists.has_vpend_valid_dirty ? "Valid+Dirty " : ""); 10750edc23eaSMarc Zyngier } 10760edc23eaSMarc Zyngier 1077d98d0a99SJulien Thierry /* Check whether it's single security state view */ 1078d98d0a99SJulien Thierry static inline bool gic_dist_security_disabled(void) 1079d98d0a99SJulien Thierry { 1080d98d0a99SJulien Thierry return readl_relaxed(gic_data.dist_base + GICD_CTLR) & GICD_CTLR_DS; 1081d98d0a99SJulien Thierry } 1082d98d0a99SJulien Thierry 10833708d52fSSudeep Holla static void gic_cpu_sys_reg_init(void) 1084021f6537SMarc Zyngier { 1085eda0d04aSShanker Donthineni int i, cpu = smp_processor_id(); 1086eda0d04aSShanker Donthineni u64 mpidr = cpu_logical_map(cpu); 1087eda0d04aSShanker Donthineni u64 need_rss = MPIDR_RS(mpidr); 108833625282SMarc Zyngier bool group0; 1089b5cf6073SJulien Thierry u32 pribits; 1090eda0d04aSShanker Donthineni 10917cabd008SMarc Zyngier /* 10927cabd008SMarc Zyngier * Need to check that the SRE bit has actually been set. If 10937cabd008SMarc Zyngier * not, it means that SRE is disabled at EL2. We're going to 10947cabd008SMarc Zyngier * die painfully, and there is nothing we can do about it. 10957cabd008SMarc Zyngier * 10967cabd008SMarc Zyngier * Kindly inform the luser. 10977cabd008SMarc Zyngier */ 10987cabd008SMarc Zyngier if (!gic_enable_sre()) 10997cabd008SMarc Zyngier pr_err("GIC: unable to set SRE (disabled at EL2), panic ahead\n"); 1100021f6537SMarc Zyngier 1101b5cf6073SJulien Thierry pribits = gic_get_pribits(); 110233625282SMarc Zyngier 1103b5cf6073SJulien Thierry group0 = gic_has_group0(); 110433625282SMarc Zyngier 1105021f6537SMarc Zyngier /* Set priority mask register */ 1106d98d0a99SJulien Thierry if (!gic_prio_masking_enabled()) { 110733625282SMarc Zyngier write_gicreg(DEFAULT_PMR_VALUE, ICC_PMR_EL1); 110833678059SAlexandru Elisei } else if (gic_supports_nmi()) { 1109d98d0a99SJulien Thierry /* 1110d98d0a99SJulien Thierry * Mismatch configuration with boot CPU, the system is likely 1111d98d0a99SJulien Thierry * to die as interrupt masking will not work properly on all 1112d98d0a99SJulien Thierry * CPUs 111333678059SAlexandru Elisei * 111433678059SAlexandru Elisei * The boot CPU calls this function before enabling NMI support, 111533678059SAlexandru Elisei * and as a result we'll never see this warning in the boot path 111633678059SAlexandru Elisei * for that CPU. 1117d98d0a99SJulien Thierry */ 111833678059SAlexandru Elisei if (static_branch_unlikely(&gic_nonsecure_priorities)) 111933678059SAlexandru Elisei WARN_ON(!group0 || gic_dist_security_disabled()); 112033678059SAlexandru Elisei else 112133678059SAlexandru Elisei WARN_ON(group0 && !gic_dist_security_disabled()); 1122d98d0a99SJulien Thierry } 1123021f6537SMarc Zyngier 112491ef8442SDaniel Thompson /* 112591ef8442SDaniel Thompson * Some firmwares hand over to the kernel with the BPR changed from 112691ef8442SDaniel Thompson * its reset value (and with a value large enough to prevent 112791ef8442SDaniel Thompson * any pre-emptive interrupts from working at all). Writing a zero 112891ef8442SDaniel Thompson * to BPR restores is reset value. 112991ef8442SDaniel Thompson */ 113091ef8442SDaniel Thompson gic_write_bpr1(0); 113191ef8442SDaniel Thompson 1132d01d3274SDavidlohr Bueso if (static_branch_likely(&supports_deactivate_key)) { 11330b6a3da9SMarc Zyngier /* EOI drops priority only (mode 1) */ 11340b6a3da9SMarc Zyngier gic_write_ctlr(ICC_CTLR_EL1_EOImode_drop); 11350b6a3da9SMarc Zyngier } else { 1136021f6537SMarc Zyngier /* EOI deactivates interrupt too (mode 0) */ 1137021f6537SMarc Zyngier gic_write_ctlr(ICC_CTLR_EL1_EOImode_drop_dir); 11380b6a3da9SMarc Zyngier } 1139021f6537SMarc Zyngier 114033625282SMarc Zyngier /* Always whack Group0 before Group1 */ 114133625282SMarc Zyngier if (group0) { 114233625282SMarc Zyngier switch(pribits) { 114333625282SMarc Zyngier case 8: 114433625282SMarc Zyngier case 7: 114533625282SMarc Zyngier write_gicreg(0, ICC_AP0R3_EL1); 114633625282SMarc Zyngier write_gicreg(0, ICC_AP0R2_EL1); 1147df561f66SGustavo A. R. Silva fallthrough; 114833625282SMarc Zyngier case 6: 114933625282SMarc Zyngier write_gicreg(0, ICC_AP0R1_EL1); 1150df561f66SGustavo A. R. Silva fallthrough; 115133625282SMarc Zyngier case 5: 115233625282SMarc Zyngier case 4: 115333625282SMarc Zyngier write_gicreg(0, ICC_AP0R0_EL1); 115433625282SMarc Zyngier } 1155d6062a6dSMarc Zyngier 115633625282SMarc Zyngier isb(); 115733625282SMarc Zyngier } 115833625282SMarc Zyngier 115933625282SMarc Zyngier switch(pribits) { 1160d6062a6dSMarc Zyngier case 8: 1161d6062a6dSMarc Zyngier case 7: 1162d6062a6dSMarc Zyngier write_gicreg(0, ICC_AP1R3_EL1); 1163d6062a6dSMarc Zyngier write_gicreg(0, ICC_AP1R2_EL1); 1164df561f66SGustavo A. R. Silva fallthrough; 1165d6062a6dSMarc Zyngier case 6: 1166d6062a6dSMarc Zyngier write_gicreg(0, ICC_AP1R1_EL1); 1167df561f66SGustavo A. R. Silva fallthrough; 1168d6062a6dSMarc Zyngier case 5: 1169d6062a6dSMarc Zyngier case 4: 1170d6062a6dSMarc Zyngier write_gicreg(0, ICC_AP1R0_EL1); 1171d6062a6dSMarc Zyngier } 1172d6062a6dSMarc Zyngier 1173d6062a6dSMarc Zyngier isb(); 1174d6062a6dSMarc Zyngier 1175021f6537SMarc Zyngier /* ... and let's hit the road... */ 1176021f6537SMarc Zyngier gic_write_grpen1(1); 1177eda0d04aSShanker Donthineni 1178eda0d04aSShanker Donthineni /* Keep the RSS capability status in per_cpu variable */ 1179eda0d04aSShanker Donthineni per_cpu(has_rss, cpu) = !!(gic_read_ctlr() & ICC_CTLR_EL1_RSS); 1180eda0d04aSShanker Donthineni 1181eda0d04aSShanker Donthineni /* Check all the CPUs have capable of sending SGIs to other CPUs */ 1182eda0d04aSShanker Donthineni for_each_online_cpu(i) { 1183eda0d04aSShanker Donthineni bool have_rss = per_cpu(has_rss, i) && per_cpu(has_rss, cpu); 1184eda0d04aSShanker Donthineni 1185eda0d04aSShanker Donthineni need_rss |= MPIDR_RS(cpu_logical_map(i)); 1186eda0d04aSShanker Donthineni if (need_rss && (!have_rss)) 1187eda0d04aSShanker Donthineni pr_crit("CPU%d (%lx) can't SGI CPU%d (%lx), no RSS\n", 1188eda0d04aSShanker Donthineni cpu, (unsigned long)mpidr, 1189eda0d04aSShanker Donthineni i, (unsigned long)cpu_logical_map(i)); 1190eda0d04aSShanker Donthineni } 1191eda0d04aSShanker Donthineni 1192eda0d04aSShanker Donthineni /** 1193eda0d04aSShanker Donthineni * GIC spec says, when ICC_CTLR_EL1.RSS==1 and GICD_TYPER.RSS==0, 1194eda0d04aSShanker Donthineni * writing ICC_ASGI1R_EL1 register with RS != 0 is a CONSTRAINED 1195eda0d04aSShanker Donthineni * UNPREDICTABLE choice of : 1196eda0d04aSShanker Donthineni * - The write is ignored. 1197eda0d04aSShanker Donthineni * - The RS field is treated as 0. 1198eda0d04aSShanker Donthineni */ 1199eda0d04aSShanker Donthineni if (need_rss && (!gic_data.has_rss)) 1200eda0d04aSShanker Donthineni pr_crit_once("RSS is required but GICD doesn't support it\n"); 1201021f6537SMarc Zyngier } 1202021f6537SMarc Zyngier 1203f736d65dSMarc Zyngier static bool gicv3_nolpi; 1204f736d65dSMarc Zyngier 1205f736d65dSMarc Zyngier static int __init gicv3_nolpi_cfg(char *buf) 1206f736d65dSMarc Zyngier { 12075e279739SChristophe JAILLET return kstrtobool(buf, &gicv3_nolpi); 1208f736d65dSMarc Zyngier } 1209f736d65dSMarc Zyngier early_param("irqchip.gicv3_nolpi", gicv3_nolpi_cfg); 1210f736d65dSMarc Zyngier 1211da33f31dSMarc Zyngier static int gic_dist_supports_lpis(void) 1212da33f31dSMarc Zyngier { 1213d38a71c5SMarc Zyngier return (IS_ENABLED(CONFIG_ARM_GIC_V3_ITS) && 1214d38a71c5SMarc Zyngier !!(readl_relaxed(gic_data.dist_base + GICD_TYPER) & GICD_TYPER_LPIS) && 1215d38a71c5SMarc Zyngier !gicv3_nolpi); 1216da33f31dSMarc Zyngier } 1217da33f31dSMarc Zyngier 1218021f6537SMarc Zyngier static void gic_cpu_init(void) 1219021f6537SMarc Zyngier { 1220021f6537SMarc Zyngier void __iomem *rbase; 12211a60e1e6SMarc Zyngier int i; 1222021f6537SMarc Zyngier 1223021f6537SMarc Zyngier /* Register ourselves with the rest of the world */ 1224021f6537SMarc Zyngier if (gic_populate_rdist()) 1225021f6537SMarc Zyngier return; 1226021f6537SMarc Zyngier 1227a2c22510SSudeep Holla gic_enable_redist(true); 1228021f6537SMarc Zyngier 1229ad5a78d3SMarc Zyngier WARN((gic_data.ppi_nr > 16 || GIC_ESPI_NR != 0) && 1230ad5a78d3SMarc Zyngier !(gic_read_ctlr() & ICC_CTLR_EL1_ExtRange), 1231ad5a78d3SMarc Zyngier "Distributor has extended ranges, but CPU%d doesn't\n", 1232ad5a78d3SMarc Zyngier smp_processor_id()); 1233ad5a78d3SMarc Zyngier 1234021f6537SMarc Zyngier rbase = gic_data_rdist_sgi_base(); 1235021f6537SMarc Zyngier 12367c9b9730SMarc Zyngier /* Configure SGIs/PPIs as non-secure Group-1 */ 12371a60e1e6SMarc Zyngier for (i = 0; i < gic_data.ppi_nr + 16; i += 32) 12381a60e1e6SMarc Zyngier writel_relaxed(~0, rbase + GICR_IGROUPR0 + i / 8); 12397c9b9730SMarc Zyngier 12401a60e1e6SMarc Zyngier gic_cpu_config(rbase, gic_data.ppi_nr + 16, gic_redist_wait_for_rwp); 1241021f6537SMarc Zyngier 12423708d52fSSudeep Holla /* initialise system registers */ 12433708d52fSSudeep Holla gic_cpu_sys_reg_init(); 1244021f6537SMarc Zyngier } 1245021f6537SMarc Zyngier 1246021f6537SMarc Zyngier #ifdef CONFIG_SMP 1247021f6537SMarc Zyngier 1248eda0d04aSShanker Donthineni #define MPIDR_TO_SGI_RS(mpidr) (MPIDR_RS(mpidr) << ICC_SGI1R_RS_SHIFT) 1249eda0d04aSShanker Donthineni #define MPIDR_TO_SGI_CLUSTER_ID(mpidr) ((mpidr) & ~0xFUL) 1250eda0d04aSShanker Donthineni 12516670a6d8SRichard Cochran static int gic_starting_cpu(unsigned int cpu) 12526670a6d8SRichard Cochran { 12536670a6d8SRichard Cochran gic_cpu_init(); 1254d38a71c5SMarc Zyngier 1255d38a71c5SMarc Zyngier if (gic_dist_supports_lpis()) 1256d38a71c5SMarc Zyngier its_cpu_init(); 1257d38a71c5SMarc Zyngier 12586670a6d8SRichard Cochran return 0; 12596670a6d8SRichard Cochran } 1260021f6537SMarc Zyngier 1261021f6537SMarc Zyngier static u16 gic_compute_target_list(int *base_cpu, const struct cpumask *mask, 1262f6c86a41SJean-Philippe Brucker unsigned long cluster_id) 1263021f6537SMarc Zyngier { 1264727653d6SJames Morse int next_cpu, cpu = *base_cpu; 1265f6c86a41SJean-Philippe Brucker unsigned long mpidr = cpu_logical_map(cpu); 1266021f6537SMarc Zyngier u16 tlist = 0; 1267021f6537SMarc Zyngier 1268021f6537SMarc Zyngier while (cpu < nr_cpu_ids) { 1269021f6537SMarc Zyngier tlist |= 1 << (mpidr & 0xf); 1270021f6537SMarc Zyngier 1271727653d6SJames Morse next_cpu = cpumask_next(cpu, mask); 1272727653d6SJames Morse if (next_cpu >= nr_cpu_ids) 1273021f6537SMarc Zyngier goto out; 1274727653d6SJames Morse cpu = next_cpu; 1275021f6537SMarc Zyngier 1276021f6537SMarc Zyngier mpidr = cpu_logical_map(cpu); 1277021f6537SMarc Zyngier 1278eda0d04aSShanker Donthineni if (cluster_id != MPIDR_TO_SGI_CLUSTER_ID(mpidr)) { 1279021f6537SMarc Zyngier cpu--; 1280021f6537SMarc Zyngier goto out; 1281021f6537SMarc Zyngier } 1282021f6537SMarc Zyngier } 1283021f6537SMarc Zyngier out: 1284021f6537SMarc Zyngier *base_cpu = cpu; 1285021f6537SMarc Zyngier return tlist; 1286021f6537SMarc Zyngier } 1287021f6537SMarc Zyngier 12887e580278SAndre Przywara #define MPIDR_TO_SGI_AFFINITY(cluster_id, level) \ 12897e580278SAndre Przywara (MPIDR_AFFINITY_LEVEL(cluster_id, level) \ 12907e580278SAndre Przywara << ICC_SGI1R_AFFINITY_## level ##_SHIFT) 12917e580278SAndre Przywara 1292021f6537SMarc Zyngier static void gic_send_sgi(u64 cluster_id, u16 tlist, unsigned int irq) 1293021f6537SMarc Zyngier { 1294021f6537SMarc Zyngier u64 val; 1295021f6537SMarc Zyngier 12967e580278SAndre Przywara val = (MPIDR_TO_SGI_AFFINITY(cluster_id, 3) | 12977e580278SAndre Przywara MPIDR_TO_SGI_AFFINITY(cluster_id, 2) | 12987e580278SAndre Przywara irq << ICC_SGI1R_SGI_ID_SHIFT | 12997e580278SAndre Przywara MPIDR_TO_SGI_AFFINITY(cluster_id, 1) | 1300eda0d04aSShanker Donthineni MPIDR_TO_SGI_RS(cluster_id) | 13017e580278SAndre Przywara tlist << ICC_SGI1R_TARGET_LIST_SHIFT); 1302021f6537SMarc Zyngier 1303b6dd4d83SMark Salter pr_devel("CPU%d: ICC_SGI1R_EL1 %llx\n", smp_processor_id(), val); 1304021f6537SMarc Zyngier gic_write_sgi1r(val); 1305021f6537SMarc Zyngier } 1306021f6537SMarc Zyngier 130764b499d8SMarc Zyngier static void gic_ipi_send_mask(struct irq_data *d, const struct cpumask *mask) 1308021f6537SMarc Zyngier { 1309021f6537SMarc Zyngier int cpu; 1310021f6537SMarc Zyngier 131164b499d8SMarc Zyngier if (WARN_ON(d->hwirq >= 16)) 1312021f6537SMarc Zyngier return; 1313021f6537SMarc Zyngier 1314021f6537SMarc Zyngier /* 1315021f6537SMarc Zyngier * Ensure that stores to Normal memory are visible to the 1316021f6537SMarc Zyngier * other CPUs before issuing the IPI. 1317021f6537SMarc Zyngier */ 131880e4e1f4SBarry Song dsb(ishst); 1319021f6537SMarc Zyngier 1320f9b531feSRusty Russell for_each_cpu(cpu, mask) { 1321eda0d04aSShanker Donthineni u64 cluster_id = MPIDR_TO_SGI_CLUSTER_ID(cpu_logical_map(cpu)); 1322021f6537SMarc Zyngier u16 tlist; 1323021f6537SMarc Zyngier 1324021f6537SMarc Zyngier tlist = gic_compute_target_list(&cpu, mask, cluster_id); 132564b499d8SMarc Zyngier gic_send_sgi(cluster_id, tlist, d->hwirq); 1326021f6537SMarc Zyngier } 1327021f6537SMarc Zyngier 1328021f6537SMarc Zyngier /* Force the above writes to ICC_SGI1R_EL1 to be executed */ 1329021f6537SMarc Zyngier isb(); 1330021f6537SMarc Zyngier } 1331021f6537SMarc Zyngier 13328a94c1abSIngo Rohloff static void __init gic_smp_init(void) 1333021f6537SMarc Zyngier { 133464b499d8SMarc Zyngier struct irq_fwspec sgi_fwspec = { 133564b499d8SMarc Zyngier .fwnode = gic_data.fwnode, 133664b499d8SMarc Zyngier .param_count = 1, 133764b499d8SMarc Zyngier }; 133864b499d8SMarc Zyngier int base_sgi; 133964b499d8SMarc Zyngier 13406896bcd1SThomas Gleixner cpuhp_setup_state_nocalls(CPUHP_AP_IRQ_GIC_STARTING, 134173c1b41eSThomas Gleixner "irqchip/arm/gicv3:starting", 134273c1b41eSThomas Gleixner gic_starting_cpu, NULL); 134364b499d8SMarc Zyngier 134464b499d8SMarc Zyngier /* Register all 8 non-secure SGIs */ 13450e2213feSJohan Hovold base_sgi = irq_domain_alloc_irqs(gic_data.domain, 8, NUMA_NO_NODE, &sgi_fwspec); 134664b499d8SMarc Zyngier if (WARN_ON(base_sgi <= 0)) 134764b499d8SMarc Zyngier return; 134864b499d8SMarc Zyngier 134964b499d8SMarc Zyngier set_smp_ipi_range(base_sgi, 8); 1350021f6537SMarc Zyngier } 1351021f6537SMarc Zyngier 1352021f6537SMarc Zyngier static int gic_set_affinity(struct irq_data *d, const struct cpumask *mask_val, 1353021f6537SMarc Zyngier bool force) 1354021f6537SMarc Zyngier { 135565a30f8bSSuzuki K Poulose unsigned int cpu; 1356e91b036eSMarc Zyngier u32 offset, index; 1357021f6537SMarc Zyngier void __iomem *reg; 1358021f6537SMarc Zyngier int enabled; 1359021f6537SMarc Zyngier u64 val; 1360021f6537SMarc Zyngier 136165a30f8bSSuzuki K Poulose if (force) 136265a30f8bSSuzuki K Poulose cpu = cpumask_first(mask_val); 136365a30f8bSSuzuki K Poulose else 136465a30f8bSSuzuki K Poulose cpu = cpumask_any_and(mask_val, cpu_online_mask); 136565a30f8bSSuzuki K Poulose 1366866d7c1bSSuzuki K Poulose if (cpu >= nr_cpu_ids) 1367866d7c1bSSuzuki K Poulose return -EINVAL; 1368866d7c1bSSuzuki K Poulose 1369021f6537SMarc Zyngier if (gic_irq_in_rdist(d)) 1370021f6537SMarc Zyngier return -EINVAL; 1371021f6537SMarc Zyngier 1372021f6537SMarc Zyngier /* If interrupt was enabled, disable it first */ 1373021f6537SMarc Zyngier enabled = gic_peek_irq(d, GICD_ISENABLER); 1374021f6537SMarc Zyngier if (enabled) 1375021f6537SMarc Zyngier gic_mask_irq(d); 1376021f6537SMarc Zyngier 1377e91b036eSMarc Zyngier offset = convert_offset_index(d, GICD_IROUTER, &index); 1378e91b036eSMarc Zyngier reg = gic_dist_base(d) + offset + (index * 8); 1379021f6537SMarc Zyngier val = gic_mpidr_to_affinity(cpu_logical_map(cpu)); 1380021f6537SMarc Zyngier 138172c97126SJean-Philippe Brucker gic_write_irouter(val, reg); 1382021f6537SMarc Zyngier 1383021f6537SMarc Zyngier /* 1384021f6537SMarc Zyngier * If the interrupt was enabled, enabled it again. Otherwise, 1385021f6537SMarc Zyngier * just wait for the distributor to have digested our changes. 1386021f6537SMarc Zyngier */ 1387021f6537SMarc Zyngier if (enabled) 1388021f6537SMarc Zyngier gic_unmask_irq(d); 1389021f6537SMarc Zyngier 1390956ae91aSMarc Zyngier irq_data_update_effective_affinity(d, cpumask_of(cpu)); 1391956ae91aSMarc Zyngier 13920fc6fa29SAntoine Tenart return IRQ_SET_MASK_OK_DONE; 1393021f6537SMarc Zyngier } 1394021f6537SMarc Zyngier #else 1395021f6537SMarc Zyngier #define gic_set_affinity NULL 139664b499d8SMarc Zyngier #define gic_ipi_send_mask NULL 1397021f6537SMarc Zyngier #define gic_smp_init() do { } while(0) 1398021f6537SMarc Zyngier #endif 1399021f6537SMarc Zyngier 140017f644e9SValentin Schneider static int gic_retrigger(struct irq_data *data) 140117f644e9SValentin Schneider { 140217f644e9SValentin Schneider return !gic_irq_set_irqchip_state(data, IRQCHIP_STATE_PENDING, true); 140317f644e9SValentin Schneider } 140417f644e9SValentin Schneider 14053708d52fSSudeep Holla #ifdef CONFIG_CPU_PM 14063708d52fSSudeep Holla static int gic_cpu_pm_notifier(struct notifier_block *self, 14073708d52fSSudeep Holla unsigned long cmd, void *v) 14083708d52fSSudeep Holla { 14093708d52fSSudeep Holla if (cmd == CPU_PM_EXIT) { 1410ccd9432aSSudeep Holla if (gic_dist_security_disabled()) 14113708d52fSSudeep Holla gic_enable_redist(true); 14123708d52fSSudeep Holla gic_cpu_sys_reg_init(); 1413ccd9432aSSudeep Holla } else if (cmd == CPU_PM_ENTER && gic_dist_security_disabled()) { 14143708d52fSSudeep Holla gic_write_grpen1(0); 14153708d52fSSudeep Holla gic_enable_redist(false); 14163708d52fSSudeep Holla } 14173708d52fSSudeep Holla return NOTIFY_OK; 14183708d52fSSudeep Holla } 14193708d52fSSudeep Holla 14203708d52fSSudeep Holla static struct notifier_block gic_cpu_pm_notifier_block = { 14213708d52fSSudeep Holla .notifier_call = gic_cpu_pm_notifier, 14223708d52fSSudeep Holla }; 14233708d52fSSudeep Holla 14243708d52fSSudeep Holla static void gic_cpu_pm_init(void) 14253708d52fSSudeep Holla { 14263708d52fSSudeep Holla cpu_pm_register_notifier(&gic_cpu_pm_notifier_block); 14273708d52fSSudeep Holla } 14283708d52fSSudeep Holla 14293708d52fSSudeep Holla #else 14303708d52fSSudeep Holla static inline void gic_cpu_pm_init(void) { } 14313708d52fSSudeep Holla #endif /* CONFIG_CPU_PM */ 14323708d52fSSudeep Holla 1433021f6537SMarc Zyngier static struct irq_chip gic_chip = { 1434021f6537SMarc Zyngier .name = "GICv3", 1435021f6537SMarc Zyngier .irq_mask = gic_mask_irq, 1436021f6537SMarc Zyngier .irq_unmask = gic_unmask_irq, 1437021f6537SMarc Zyngier .irq_eoi = gic_eoi_irq, 1438021f6537SMarc Zyngier .irq_set_type = gic_set_type, 1439021f6537SMarc Zyngier .irq_set_affinity = gic_set_affinity, 144017f644e9SValentin Schneider .irq_retrigger = gic_retrigger, 1441b594c6e2SMarc Zyngier .irq_get_irqchip_state = gic_irq_get_irqchip_state, 1442b594c6e2SMarc Zyngier .irq_set_irqchip_state = gic_irq_set_irqchip_state, 1443101b35f7SJulien Thierry .irq_nmi_setup = gic_irq_nmi_setup, 1444101b35f7SJulien Thierry .irq_nmi_teardown = gic_irq_nmi_teardown, 144564b499d8SMarc Zyngier .ipi_send_mask = gic_ipi_send_mask, 14464110b5cbSMarc Zyngier .flags = IRQCHIP_SET_TYPE_MASKED | 14474110b5cbSMarc Zyngier IRQCHIP_SKIP_SET_WAKE | 14484110b5cbSMarc Zyngier IRQCHIP_MASK_ON_SUSPEND, 1449021f6537SMarc Zyngier }; 1450021f6537SMarc Zyngier 14510b6a3da9SMarc Zyngier static struct irq_chip gic_eoimode1_chip = { 14520b6a3da9SMarc Zyngier .name = "GICv3", 14530b6a3da9SMarc Zyngier .irq_mask = gic_eoimode1_mask_irq, 14540b6a3da9SMarc Zyngier .irq_unmask = gic_unmask_irq, 14550b6a3da9SMarc Zyngier .irq_eoi = gic_eoimode1_eoi_irq, 14560b6a3da9SMarc Zyngier .irq_set_type = gic_set_type, 14570b6a3da9SMarc Zyngier .irq_set_affinity = gic_set_affinity, 145817f644e9SValentin Schneider .irq_retrigger = gic_retrigger, 14590b6a3da9SMarc Zyngier .irq_get_irqchip_state = gic_irq_get_irqchip_state, 14600b6a3da9SMarc Zyngier .irq_set_irqchip_state = gic_irq_set_irqchip_state, 1461530bf353SMarc Zyngier .irq_set_vcpu_affinity = gic_irq_set_vcpu_affinity, 1462101b35f7SJulien Thierry .irq_nmi_setup = gic_irq_nmi_setup, 1463101b35f7SJulien Thierry .irq_nmi_teardown = gic_irq_nmi_teardown, 146464b499d8SMarc Zyngier .ipi_send_mask = gic_ipi_send_mask, 14654110b5cbSMarc Zyngier .flags = IRQCHIP_SET_TYPE_MASKED | 14664110b5cbSMarc Zyngier IRQCHIP_SKIP_SET_WAKE | 14674110b5cbSMarc Zyngier IRQCHIP_MASK_ON_SUSPEND, 14680b6a3da9SMarc Zyngier }; 14690b6a3da9SMarc Zyngier 1470021f6537SMarc Zyngier static int gic_irq_domain_map(struct irq_domain *d, unsigned int irq, 1471021f6537SMarc Zyngier irq_hw_number_t hw) 1472021f6537SMarc Zyngier { 14730b6a3da9SMarc Zyngier struct irq_chip *chip = &gic_chip; 14741b57d91bSValentin Schneider struct irq_data *irqd = irq_desc_get_irq_data(irq_to_desc(irq)); 14750b6a3da9SMarc Zyngier 1476d01d3274SDavidlohr Bueso if (static_branch_likely(&supports_deactivate_key)) 14770b6a3da9SMarc Zyngier chip = &gic_eoimode1_chip; 14780b6a3da9SMarc Zyngier 1479e91b036eSMarc Zyngier switch (__get_intid_range(hw)) { 148070a29c32SMarc Zyngier case SGI_RANGE: 1481e91b036eSMarc Zyngier case PPI_RANGE: 14825f51f803SMarc Zyngier case EPPI_RANGE: 1483021f6537SMarc Zyngier irq_set_percpu_devid(irq); 14840b6a3da9SMarc Zyngier irq_domain_set_info(d, irq, hw, chip, d->host_data, 1485443acc4fSMarc Zyngier handle_percpu_devid_irq, NULL, NULL); 1486e91b036eSMarc Zyngier break; 1487e91b036eSMarc Zyngier 1488e91b036eSMarc Zyngier case SPI_RANGE: 1489211bddd2SMarc Zyngier case ESPI_RANGE: 14900b6a3da9SMarc Zyngier irq_domain_set_info(d, irq, hw, chip, d->host_data, 1491443acc4fSMarc Zyngier handle_fasteoi_irq, NULL, NULL); 1492d17cab44SRob Herring irq_set_probe(irq); 14931b57d91bSValentin Schneider irqd_set_single_target(irqd); 1494e91b036eSMarc Zyngier break; 1495e91b036eSMarc Zyngier 1496e91b036eSMarc Zyngier case LPI_RANGE: 1497da33f31dSMarc Zyngier if (!gic_dist_supports_lpis()) 1498da33f31dSMarc Zyngier return -EPERM; 14990b6a3da9SMarc Zyngier irq_domain_set_info(d, irq, hw, chip, d->host_data, 1500da33f31dSMarc Zyngier handle_fasteoi_irq, NULL, NULL); 1501e91b036eSMarc Zyngier break; 1502e91b036eSMarc Zyngier 1503e91b036eSMarc Zyngier default: 1504e91b036eSMarc Zyngier return -EPERM; 1505da33f31dSMarc Zyngier } 1506da33f31dSMarc Zyngier 15071b57d91bSValentin Schneider /* Prevents SW retriggers which mess up the ACK/EOI ordering */ 15081b57d91bSValentin Schneider irqd_set_handle_enforce_irqctx(irqd); 1509021f6537SMarc Zyngier return 0; 1510021f6537SMarc Zyngier } 1511021f6537SMarc Zyngier 1512f833f57fSMarc Zyngier static int gic_irq_domain_translate(struct irq_domain *d, 1513f833f57fSMarc Zyngier struct irq_fwspec *fwspec, 1514f833f57fSMarc Zyngier unsigned long *hwirq, 1515f833f57fSMarc Zyngier unsigned int *type) 1516021f6537SMarc Zyngier { 151764b499d8SMarc Zyngier if (fwspec->param_count == 1 && fwspec->param[0] < 16) { 151864b499d8SMarc Zyngier *hwirq = fwspec->param[0]; 151964b499d8SMarc Zyngier *type = IRQ_TYPE_EDGE_RISING; 152064b499d8SMarc Zyngier return 0; 152164b499d8SMarc Zyngier } 152264b499d8SMarc Zyngier 1523f833f57fSMarc Zyngier if (is_of_node(fwspec->fwnode)) { 1524f833f57fSMarc Zyngier if (fwspec->param_count < 3) 1525021f6537SMarc Zyngier return -EINVAL; 1526021f6537SMarc Zyngier 1527db8c70ecSMarc Zyngier switch (fwspec->param[0]) { 1528db8c70ecSMarc Zyngier case 0: /* SPI */ 1529db8c70ecSMarc Zyngier *hwirq = fwspec->param[1] + 32; 1530db8c70ecSMarc Zyngier break; 1531db8c70ecSMarc Zyngier case 1: /* PPI */ 1532f833f57fSMarc Zyngier *hwirq = fwspec->param[1] + 16; 1533db8c70ecSMarc Zyngier break; 1534211bddd2SMarc Zyngier case 2: /* ESPI */ 1535211bddd2SMarc Zyngier *hwirq = fwspec->param[1] + ESPI_BASE_INTID; 1536211bddd2SMarc Zyngier break; 15375f51f803SMarc Zyngier case 3: /* EPPI */ 15385f51f803SMarc Zyngier *hwirq = fwspec->param[1] + EPPI_BASE_INTID; 15395f51f803SMarc Zyngier break; 1540db8c70ecSMarc Zyngier case GIC_IRQ_TYPE_LPI: /* LPI */ 1541db8c70ecSMarc Zyngier *hwirq = fwspec->param[1]; 1542db8c70ecSMarc Zyngier break; 15435f51f803SMarc Zyngier case GIC_IRQ_TYPE_PARTITION: 15445f51f803SMarc Zyngier *hwirq = fwspec->param[1]; 15455f51f803SMarc Zyngier if (fwspec->param[1] >= 16) 15465f51f803SMarc Zyngier *hwirq += EPPI_BASE_INTID - 16; 15475f51f803SMarc Zyngier else 15485f51f803SMarc Zyngier *hwirq += 16; 15495f51f803SMarc Zyngier break; 1550db8c70ecSMarc Zyngier default: 1551db8c70ecSMarc Zyngier return -EINVAL; 1552db8c70ecSMarc Zyngier } 1553f833f57fSMarc Zyngier 1554f833f57fSMarc Zyngier *type = fwspec->param[2] & IRQ_TYPE_SENSE_MASK; 15556ef6386eSMarc Zyngier 155665da7d19SMarc Zyngier /* 155765da7d19SMarc Zyngier * Make it clear that broken DTs are... broken. 1558a359f757SIngo Molnar * Partitioned PPIs are an unfortunate exception. 155965da7d19SMarc Zyngier */ 156065da7d19SMarc Zyngier WARN_ON(*type == IRQ_TYPE_NONE && 156165da7d19SMarc Zyngier fwspec->param[0] != GIC_IRQ_TYPE_PARTITION); 1562f833f57fSMarc Zyngier return 0; 1563021f6537SMarc Zyngier } 1564021f6537SMarc Zyngier 1565ffa7d616STomasz Nowicki if (is_fwnode_irqchip(fwspec->fwnode)) { 1566ffa7d616STomasz Nowicki if(fwspec->param_count != 2) 1567ffa7d616STomasz Nowicki return -EINVAL; 1568ffa7d616STomasz Nowicki 1569544808f7SAndre Przywara if (fwspec->param[0] < 16) { 1570544808f7SAndre Przywara pr_err(FW_BUG "Illegal GSI%d translation request\n", 1571544808f7SAndre Przywara fwspec->param[0]); 1572544808f7SAndre Przywara return -EINVAL; 1573544808f7SAndre Przywara } 1574544808f7SAndre Przywara 1575ffa7d616STomasz Nowicki *hwirq = fwspec->param[0]; 1576ffa7d616STomasz Nowicki *type = fwspec->param[1]; 15776ef6386eSMarc Zyngier 15786ef6386eSMarc Zyngier WARN_ON(*type == IRQ_TYPE_NONE); 1579ffa7d616STomasz Nowicki return 0; 1580ffa7d616STomasz Nowicki } 1581ffa7d616STomasz Nowicki 1582f833f57fSMarc Zyngier return -EINVAL; 1583021f6537SMarc Zyngier } 1584021f6537SMarc Zyngier 1585443acc4fSMarc Zyngier static int gic_irq_domain_alloc(struct irq_domain *domain, unsigned int virq, 1586443acc4fSMarc Zyngier unsigned int nr_irqs, void *arg) 1587443acc4fSMarc Zyngier { 1588443acc4fSMarc Zyngier int i, ret; 1589443acc4fSMarc Zyngier irq_hw_number_t hwirq; 1590443acc4fSMarc Zyngier unsigned int type = IRQ_TYPE_NONE; 1591f833f57fSMarc Zyngier struct irq_fwspec *fwspec = arg; 1592443acc4fSMarc Zyngier 1593f833f57fSMarc Zyngier ret = gic_irq_domain_translate(domain, fwspec, &hwirq, &type); 1594443acc4fSMarc Zyngier if (ret) 1595443acc4fSMarc Zyngier return ret; 1596443acc4fSMarc Zyngier 159763c16c6eSSuzuki K Poulose for (i = 0; i < nr_irqs; i++) { 159863c16c6eSSuzuki K Poulose ret = gic_irq_domain_map(domain, virq + i, hwirq + i); 159963c16c6eSSuzuki K Poulose if (ret) 160063c16c6eSSuzuki K Poulose return ret; 160163c16c6eSSuzuki K Poulose } 1602443acc4fSMarc Zyngier 1603443acc4fSMarc Zyngier return 0; 1604443acc4fSMarc Zyngier } 1605443acc4fSMarc Zyngier 1606443acc4fSMarc Zyngier static void gic_irq_domain_free(struct irq_domain *domain, unsigned int virq, 1607443acc4fSMarc Zyngier unsigned int nr_irqs) 1608443acc4fSMarc Zyngier { 1609443acc4fSMarc Zyngier int i; 1610443acc4fSMarc Zyngier 1611443acc4fSMarc Zyngier for (i = 0; i < nr_irqs; i++) { 1612443acc4fSMarc Zyngier struct irq_data *d = irq_domain_get_irq_data(domain, virq + i); 1613443acc4fSMarc Zyngier irq_set_handler(virq + i, NULL); 1614443acc4fSMarc Zyngier irq_domain_reset_irq_data(d); 1615443acc4fSMarc Zyngier } 1616443acc4fSMarc Zyngier } 1617443acc4fSMarc Zyngier 1618d753f849SJames Morse static bool fwspec_is_partitioned_ppi(struct irq_fwspec *fwspec, 1619d753f849SJames Morse irq_hw_number_t hwirq) 1620d753f849SJames Morse { 1621d753f849SJames Morse enum gic_intid_range range; 1622d753f849SJames Morse 1623d753f849SJames Morse if (!gic_data.ppi_descs) 1624d753f849SJames Morse return false; 1625d753f849SJames Morse 1626d753f849SJames Morse if (!is_of_node(fwspec->fwnode)) 1627d753f849SJames Morse return false; 1628d753f849SJames Morse 1629d753f849SJames Morse if (fwspec->param_count < 4 || !fwspec->param[3]) 1630d753f849SJames Morse return false; 1631d753f849SJames Morse 1632d753f849SJames Morse range = __get_intid_range(hwirq); 1633d753f849SJames Morse if (range != PPI_RANGE && range != EPPI_RANGE) 1634d753f849SJames Morse return false; 1635d753f849SJames Morse 1636d753f849SJames Morse return true; 1637d753f849SJames Morse } 1638d753f849SJames Morse 1639e3825ba1SMarc Zyngier static int gic_irq_domain_select(struct irq_domain *d, 1640e3825ba1SMarc Zyngier struct irq_fwspec *fwspec, 1641e3825ba1SMarc Zyngier enum irq_domain_bus_token bus_token) 1642e3825ba1SMarc Zyngier { 1643d753f849SJames Morse unsigned int type, ret, ppi_idx; 1644d753f849SJames Morse irq_hw_number_t hwirq; 1645d753f849SJames Morse 1646e3825ba1SMarc Zyngier /* Not for us */ 1647e3825ba1SMarc Zyngier if (fwspec->fwnode != d->fwnode) 1648e3825ba1SMarc Zyngier return 0; 1649e3825ba1SMarc Zyngier 1650e3825ba1SMarc Zyngier /* If this is not DT, then we have a single domain */ 1651e3825ba1SMarc Zyngier if (!is_of_node(fwspec->fwnode)) 1652e3825ba1SMarc Zyngier return 1; 1653e3825ba1SMarc Zyngier 1654d753f849SJames Morse ret = gic_irq_domain_translate(d, fwspec, &hwirq, &type); 1655d753f849SJames Morse if (WARN_ON_ONCE(ret)) 1656d753f849SJames Morse return 0; 1657d753f849SJames Morse 1658d753f849SJames Morse if (!fwspec_is_partitioned_ppi(fwspec, hwirq)) 1659d753f849SJames Morse return d == gic_data.domain; 1660d753f849SJames Morse 1661e3825ba1SMarc Zyngier /* 1662e3825ba1SMarc Zyngier * If this is a PPI and we have a 4th (non-null) parameter, 1663e3825ba1SMarc Zyngier * then we need to match the partition domain. 1664e3825ba1SMarc Zyngier */ 1665d753f849SJames Morse ppi_idx = __gic_get_ppi_index(hwirq); 1666d753f849SJames Morse return d == partition_get_domain(gic_data.ppi_descs[ppi_idx]); 1667e3825ba1SMarc Zyngier } 1668e3825ba1SMarc Zyngier 1669021f6537SMarc Zyngier static const struct irq_domain_ops gic_irq_domain_ops = { 1670f833f57fSMarc Zyngier .translate = gic_irq_domain_translate, 1671443acc4fSMarc Zyngier .alloc = gic_irq_domain_alloc, 1672443acc4fSMarc Zyngier .free = gic_irq_domain_free, 1673e3825ba1SMarc Zyngier .select = gic_irq_domain_select, 1674e3825ba1SMarc Zyngier }; 1675e3825ba1SMarc Zyngier 1676e3825ba1SMarc Zyngier static int partition_domain_translate(struct irq_domain *d, 1677e3825ba1SMarc Zyngier struct irq_fwspec *fwspec, 1678e3825ba1SMarc Zyngier unsigned long *hwirq, 1679e3825ba1SMarc Zyngier unsigned int *type) 1680e3825ba1SMarc Zyngier { 1681d753f849SJames Morse unsigned long ppi_intid; 1682e3825ba1SMarc Zyngier struct device_node *np; 1683d753f849SJames Morse unsigned int ppi_idx; 1684e3825ba1SMarc Zyngier int ret; 1685e3825ba1SMarc Zyngier 168652085d3fSMarc Zyngier if (!gic_data.ppi_descs) 168752085d3fSMarc Zyngier return -ENOMEM; 168852085d3fSMarc Zyngier 1689e3825ba1SMarc Zyngier np = of_find_node_by_phandle(fwspec->param[3]); 1690e3825ba1SMarc Zyngier if (WARN_ON(!np)) 1691e3825ba1SMarc Zyngier return -EINVAL; 1692e3825ba1SMarc Zyngier 1693d753f849SJames Morse ret = gic_irq_domain_translate(d, fwspec, &ppi_intid, type); 1694d753f849SJames Morse if (WARN_ON_ONCE(ret)) 1695d753f849SJames Morse return 0; 1696d753f849SJames Morse 1697d753f849SJames Morse ppi_idx = __gic_get_ppi_index(ppi_intid); 1698d753f849SJames Morse ret = partition_translate_id(gic_data.ppi_descs[ppi_idx], 1699e3825ba1SMarc Zyngier of_node_to_fwnode(np)); 1700e3825ba1SMarc Zyngier if (ret < 0) 1701e3825ba1SMarc Zyngier return ret; 1702e3825ba1SMarc Zyngier 1703e3825ba1SMarc Zyngier *hwirq = ret; 1704e3825ba1SMarc Zyngier *type = fwspec->param[2] & IRQ_TYPE_SENSE_MASK; 1705e3825ba1SMarc Zyngier 1706e3825ba1SMarc Zyngier return 0; 1707e3825ba1SMarc Zyngier } 1708e3825ba1SMarc Zyngier 1709e3825ba1SMarc Zyngier static const struct irq_domain_ops partition_domain_ops = { 1710e3825ba1SMarc Zyngier .translate = partition_domain_translate, 1711e3825ba1SMarc Zyngier .select = gic_irq_domain_select, 1712021f6537SMarc Zyngier }; 1713021f6537SMarc Zyngier 17149c8114c2SSrinivas Kandagatla static bool gic_enable_quirk_msm8996(void *data) 17159c8114c2SSrinivas Kandagatla { 17169c8114c2SSrinivas Kandagatla struct gic_chip_data *d = data; 17179c8114c2SSrinivas Kandagatla 17189c8114c2SSrinivas Kandagatla d->flags |= FLAGS_WORKAROUND_GICR_WAKER_MSM8996; 17199c8114c2SSrinivas Kandagatla 17209c8114c2SSrinivas Kandagatla return true; 17219c8114c2SSrinivas Kandagatla } 17229c8114c2SSrinivas Kandagatla 1723d01fd161SMarc Zyngier static bool gic_enable_quirk_cavium_38539(void *data) 1724d01fd161SMarc Zyngier { 1725d01fd161SMarc Zyngier struct gic_chip_data *d = data; 1726d01fd161SMarc Zyngier 1727d01fd161SMarc Zyngier d->flags |= FLAGS_WORKAROUND_CAVIUM_ERRATUM_38539; 1728d01fd161SMarc Zyngier 1729d01fd161SMarc Zyngier return true; 1730d01fd161SMarc Zyngier } 1731d01fd161SMarc Zyngier 17327f2481b3SMarc Zyngier static bool gic_enable_quirk_hip06_07(void *data) 17337f2481b3SMarc Zyngier { 17347f2481b3SMarc Zyngier struct gic_chip_data *d = data; 17357f2481b3SMarc Zyngier 17367f2481b3SMarc Zyngier /* 17377f2481b3SMarc Zyngier * HIP06 GICD_IIDR clashes with GIC-600 product number (despite 17387f2481b3SMarc Zyngier * not being an actual ARM implementation). The saving grace is 17397f2481b3SMarc Zyngier * that GIC-600 doesn't have ESPI, so nothing to do in that case. 17407f2481b3SMarc Zyngier * HIP07 doesn't even have a proper IIDR, and still pretends to 17417f2481b3SMarc Zyngier * have ESPI. In both cases, put them right. 17427f2481b3SMarc Zyngier */ 17437f2481b3SMarc Zyngier if (d->rdists.gicd_typer & GICD_TYPER_ESPI) { 17447f2481b3SMarc Zyngier /* Zero both ESPI and the RES0 field next to it... */ 17457f2481b3SMarc Zyngier d->rdists.gicd_typer &= ~GENMASK(9, 8); 17467f2481b3SMarc Zyngier return true; 17477f2481b3SMarc Zyngier } 17487f2481b3SMarc Zyngier 17497f2481b3SMarc Zyngier return false; 17507f2481b3SMarc Zyngier } 17517f2481b3SMarc Zyngier 1752*35727af2SShanker Donthineni #define T241_CHIPN_MASK GENMASK_ULL(45, 44) 1753*35727af2SShanker Donthineni #define T241_CHIP_GICDA_OFFSET 0x1580000 1754*35727af2SShanker Donthineni #define SMCCC_SOC_ID_T241 0x036b0241 1755*35727af2SShanker Donthineni 1756*35727af2SShanker Donthineni static bool gic_enable_quirk_nvidia_t241(void *data) 1757*35727af2SShanker Donthineni { 1758*35727af2SShanker Donthineni s32 soc_id = arm_smccc_get_soc_id_version(); 1759*35727af2SShanker Donthineni unsigned long chip_bmask = 0; 1760*35727af2SShanker Donthineni phys_addr_t phys; 1761*35727af2SShanker Donthineni u32 i; 1762*35727af2SShanker Donthineni 1763*35727af2SShanker Donthineni /* Check JEP106 code for NVIDIA T241 chip (036b:0241) */ 1764*35727af2SShanker Donthineni if ((soc_id < 0) || (soc_id != SMCCC_SOC_ID_T241)) 1765*35727af2SShanker Donthineni return false; 1766*35727af2SShanker Donthineni 1767*35727af2SShanker Donthineni /* Find the chips based on GICR regions PHYS addr */ 1768*35727af2SShanker Donthineni for (i = 0; i < gic_data.nr_redist_regions; i++) { 1769*35727af2SShanker Donthineni chip_bmask |= BIT(FIELD_GET(T241_CHIPN_MASK, 1770*35727af2SShanker Donthineni (u64)gic_data.redist_regions[i].phys_base)); 1771*35727af2SShanker Donthineni } 1772*35727af2SShanker Donthineni 1773*35727af2SShanker Donthineni if (hweight32(chip_bmask) < 3) 1774*35727af2SShanker Donthineni return false; 1775*35727af2SShanker Donthineni 1776*35727af2SShanker Donthineni /* Setup GICD alias regions */ 1777*35727af2SShanker Donthineni for (i = 0; i < ARRAY_SIZE(t241_dist_base_alias); i++) { 1778*35727af2SShanker Donthineni if (chip_bmask & BIT(i)) { 1779*35727af2SShanker Donthineni phys = gic_data.dist_phys_base + T241_CHIP_GICDA_OFFSET; 1780*35727af2SShanker Donthineni phys |= FIELD_PREP(T241_CHIPN_MASK, i); 1781*35727af2SShanker Donthineni t241_dist_base_alias[i] = ioremap(phys, SZ_64K); 1782*35727af2SShanker Donthineni WARN_ON_ONCE(!t241_dist_base_alias[i]); 1783*35727af2SShanker Donthineni } 1784*35727af2SShanker Donthineni } 1785*35727af2SShanker Donthineni static_branch_enable(&gic_nvidia_t241_erratum); 1786*35727af2SShanker Donthineni return true; 1787*35727af2SShanker Donthineni } 1788*35727af2SShanker Donthineni 17897f2481b3SMarc Zyngier static const struct gic_quirk gic_quirks[] = { 17907f2481b3SMarc Zyngier { 17917f2481b3SMarc Zyngier .desc = "GICv3: Qualcomm MSM8996 broken firmware", 17927f2481b3SMarc Zyngier .compatible = "qcom,msm8996-gic-v3", 17937f2481b3SMarc Zyngier .init = gic_enable_quirk_msm8996, 17947f2481b3SMarc Zyngier }, 17957f2481b3SMarc Zyngier { 17967f2481b3SMarc Zyngier .desc = "GICv3: HIP06 erratum 161010803", 17977f2481b3SMarc Zyngier .iidr = 0x0204043b, 17987f2481b3SMarc Zyngier .mask = 0xffffffff, 17997f2481b3SMarc Zyngier .init = gic_enable_quirk_hip06_07, 18007f2481b3SMarc Zyngier }, 18017f2481b3SMarc Zyngier { 18027f2481b3SMarc Zyngier .desc = "GICv3: HIP07 erratum 161010803", 18037f2481b3SMarc Zyngier .iidr = 0x00000000, 18047f2481b3SMarc Zyngier .mask = 0xffffffff, 18057f2481b3SMarc Zyngier .init = gic_enable_quirk_hip06_07, 18067f2481b3SMarc Zyngier }, 18077f2481b3SMarc Zyngier { 1808d01fd161SMarc Zyngier /* 1809d01fd161SMarc Zyngier * Reserved register accesses generate a Synchronous 1810d01fd161SMarc Zyngier * External Abort. This erratum applies to: 1811d01fd161SMarc Zyngier * - ThunderX: CN88xx 1812d01fd161SMarc Zyngier * - OCTEON TX: CN83xx, CN81xx 1813d01fd161SMarc Zyngier * - OCTEON TX2: CN93xx, CN96xx, CN98xx, CNF95xx* 1814d01fd161SMarc Zyngier */ 1815d01fd161SMarc Zyngier .desc = "GICv3: Cavium erratum 38539", 1816d01fd161SMarc Zyngier .iidr = 0xa000034c, 1817d01fd161SMarc Zyngier .mask = 0xe8f00fff, 1818d01fd161SMarc Zyngier .init = gic_enable_quirk_cavium_38539, 1819d01fd161SMarc Zyngier }, 1820d01fd161SMarc Zyngier { 1821*35727af2SShanker Donthineni .desc = "GICv3: NVIDIA erratum T241-FABRIC-4", 1822*35727af2SShanker Donthineni .iidr = 0x0402043b, 1823*35727af2SShanker Donthineni .mask = 0xffffffff, 1824*35727af2SShanker Donthineni .init = gic_enable_quirk_nvidia_t241, 1825*35727af2SShanker Donthineni }, 1826*35727af2SShanker Donthineni { 18277f2481b3SMarc Zyngier } 18287f2481b3SMarc Zyngier }; 18297f2481b3SMarc Zyngier 1830d98d0a99SJulien Thierry static void gic_enable_nmi_support(void) 1831d98d0a99SJulien Thierry { 1832101b35f7SJulien Thierry int i; 1833101b35f7SJulien Thierry 183481a43273SMarc Zyngier if (!gic_prio_masking_enabled()) 183581a43273SMarc Zyngier return; 183681a43273SMarc Zyngier 183781a43273SMarc Zyngier ppi_nmi_refs = kcalloc(gic_data.ppi_nr, sizeof(*ppi_nmi_refs), GFP_KERNEL); 183881a43273SMarc Zyngier if (!ppi_nmi_refs) 183981a43273SMarc Zyngier return; 184081a43273SMarc Zyngier 184181a43273SMarc Zyngier for (i = 0; i < gic_data.ppi_nr; i++) 1842101b35f7SJulien Thierry refcount_set(&ppi_nmi_refs[i], 0); 1843101b35f7SJulien Thierry 18444e594ad1SAlexandru Elisei pr_info("Pseudo-NMIs enabled using %s ICC_PMR_EL1 synchronisation\n", 18458bf0a804SMark Rutland gic_has_relaxed_pmr_sync() ? "relaxed" : "forced"); 1846f2266504SMarc Zyngier 184733678059SAlexandru Elisei /* 184833678059SAlexandru Elisei * How priority values are used by the GIC depends on two things: 184933678059SAlexandru Elisei * the security state of the GIC (controlled by the GICD_CTRL.DS bit) 185033678059SAlexandru Elisei * and if Group 0 interrupts can be delivered to Linux in the non-secure 185133678059SAlexandru Elisei * world as FIQs (controlled by the SCR_EL3.FIQ bit). These affect the 185229517170SJason Wang * ICC_PMR_EL1 register and the priority that software assigns to 185333678059SAlexandru Elisei * interrupts: 185433678059SAlexandru Elisei * 185533678059SAlexandru Elisei * GICD_CTRL.DS | SCR_EL3.FIQ | ICC_PMR_EL1 | Group 1 priority 185633678059SAlexandru Elisei * ----------------------------------------------------------- 185733678059SAlexandru Elisei * 1 | - | unchanged | unchanged 185833678059SAlexandru Elisei * ----------------------------------------------------------- 185933678059SAlexandru Elisei * 0 | 1 | non-secure | non-secure 186033678059SAlexandru Elisei * ----------------------------------------------------------- 186133678059SAlexandru Elisei * 0 | 0 | unchanged | non-secure 186233678059SAlexandru Elisei * 186333678059SAlexandru Elisei * where non-secure means that the value is right-shifted by one and the 186433678059SAlexandru Elisei * MSB bit set, to make it fit in the non-secure priority range. 186533678059SAlexandru Elisei * 186633678059SAlexandru Elisei * In the first two cases, where ICC_PMR_EL1 and the interrupt priority 186733678059SAlexandru Elisei * are both either modified or unchanged, we can use the same set of 186833678059SAlexandru Elisei * priorities. 186933678059SAlexandru Elisei * 187033678059SAlexandru Elisei * In the last case, where only the interrupt priorities are modified to 187133678059SAlexandru Elisei * be in the non-secure range, we use a different PMR value to mask IRQs 187233678059SAlexandru Elisei * and the rest of the values that we use remain unchanged. 187333678059SAlexandru Elisei */ 187433678059SAlexandru Elisei if (gic_has_group0() && !gic_dist_security_disabled()) 187533678059SAlexandru Elisei static_branch_enable(&gic_nonsecure_priorities); 187633678059SAlexandru Elisei 1877d98d0a99SJulien Thierry static_branch_enable(&supports_pseudo_nmis); 1878101b35f7SJulien Thierry 1879101b35f7SJulien Thierry if (static_branch_likely(&supports_deactivate_key)) 1880101b35f7SJulien Thierry gic_eoimode1_chip.flags |= IRQCHIP_SUPPORTS_NMI; 1881101b35f7SJulien Thierry else 1882101b35f7SJulien Thierry gic_chip.flags |= IRQCHIP_SUPPORTS_NMI; 1883d98d0a99SJulien Thierry } 1884d98d0a99SJulien Thierry 1885*35727af2SShanker Donthineni static int __init gic_init_bases(phys_addr_t dist_phys_base, 1886*35727af2SShanker Donthineni void __iomem *dist_base, 1887db57d746STomasz Nowicki struct redist_region *rdist_regs, 1888db57d746STomasz Nowicki u32 nr_redist_regions, 1889db57d746STomasz Nowicki u64 redist_stride, 1890db57d746STomasz Nowicki struct fwnode_handle *handle) 1891db57d746STomasz Nowicki { 1892db57d746STomasz Nowicki u32 typer; 1893db57d746STomasz Nowicki int err; 1894db57d746STomasz Nowicki 1895db57d746STomasz Nowicki if (!is_hyp_mode_available()) 1896d01d3274SDavidlohr Bueso static_branch_disable(&supports_deactivate_key); 1897db57d746STomasz Nowicki 1898d01d3274SDavidlohr Bueso if (static_branch_likely(&supports_deactivate_key)) 1899db57d746STomasz Nowicki pr_info("GIC: Using split EOI/Deactivate mode\n"); 1900db57d746STomasz Nowicki 1901e3825ba1SMarc Zyngier gic_data.fwnode = handle; 1902*35727af2SShanker Donthineni gic_data.dist_phys_base = dist_phys_base; 1903db57d746STomasz Nowicki gic_data.dist_base = dist_base; 1904db57d746STomasz Nowicki gic_data.redist_regions = rdist_regs; 1905db57d746STomasz Nowicki gic_data.nr_redist_regions = nr_redist_regions; 1906db57d746STomasz Nowicki gic_data.redist_stride = redist_stride; 1907db57d746STomasz Nowicki 1908db57d746STomasz Nowicki /* 1909db57d746STomasz Nowicki * Find out how many interrupts are supported. 1910db57d746STomasz Nowicki */ 1911db57d746STomasz Nowicki typer = readl_relaxed(gic_data.dist_base + GICD_TYPER); 1912a4f9edb2SMarc Zyngier gic_data.rdists.gicd_typer = typer; 19137f2481b3SMarc Zyngier 19147f2481b3SMarc Zyngier gic_enable_quirks(readl_relaxed(gic_data.dist_base + GICD_IIDR), 19157f2481b3SMarc Zyngier gic_quirks, &gic_data); 19167f2481b3SMarc Zyngier 1917211bddd2SMarc Zyngier pr_info("%d SPIs implemented\n", GIC_LINE_NR - 32); 1918211bddd2SMarc Zyngier pr_info("%d Extended SPIs implemented\n", GIC_ESPI_NR); 1919f2d83409SMarc Zyngier 1920d01fd161SMarc Zyngier /* 1921d01fd161SMarc Zyngier * ThunderX1 explodes on reading GICD_TYPER2, in violation of the 1922d01fd161SMarc Zyngier * architecture spec (which says that reserved registers are RES0). 1923d01fd161SMarc Zyngier */ 1924d01fd161SMarc Zyngier if (!(gic_data.flags & FLAGS_WORKAROUND_CAVIUM_ERRATUM_38539)) 1925f2d83409SMarc Zyngier gic_data.rdists.gicd_typer2 = readl_relaxed(gic_data.dist_base + GICD_TYPER2); 1926f2d83409SMarc Zyngier 1927db57d746STomasz Nowicki gic_data.domain = irq_domain_create_tree(handle, &gic_irq_domain_ops, 1928db57d746STomasz Nowicki &gic_data); 1929db57d746STomasz Nowicki gic_data.rdists.rdist = alloc_percpu(typeof(*gic_data.rdists.rdist)); 1930*35727af2SShanker Donthineni if (!static_branch_unlikely(&gic_nvidia_t241_erratum)) { 1931*35727af2SShanker Donthineni /* Disable GICv4.x features for the erratum T241-FABRIC-4 */ 1932b25319d2SMarc Zyngier gic_data.rdists.has_rvpeid = true; 19330edc23eaSMarc Zyngier gic_data.rdists.has_vlpis = true; 19340edc23eaSMarc Zyngier gic_data.rdists.has_direct_lpi = true; 193596806229SMarc Zyngier gic_data.rdists.has_vpend_valid_dirty = true; 1936*35727af2SShanker Donthineni } 1937db57d746STomasz Nowicki 1938db57d746STomasz Nowicki if (WARN_ON(!gic_data.domain) || WARN_ON(!gic_data.rdists.rdist)) { 1939db57d746STomasz Nowicki err = -ENOMEM; 1940db57d746STomasz Nowicki goto out_free; 1941db57d746STomasz Nowicki } 1942db57d746STomasz Nowicki 1943eeaa4b24Sluanshi irq_domain_update_bus_token(gic_data.domain, DOMAIN_BUS_WIRED); 1944eeaa4b24Sluanshi 1945eda0d04aSShanker Donthineni gic_data.has_rss = !!(typer & GICD_TYPER_RSS); 1946eda0d04aSShanker Donthineni 194750528752SMarc Zyngier if (typer & GICD_TYPER_MBIS) { 194850528752SMarc Zyngier err = mbi_init(handle, gic_data.domain); 194950528752SMarc Zyngier if (err) 195050528752SMarc Zyngier pr_err("Failed to initialize MBIs\n"); 195150528752SMarc Zyngier } 195250528752SMarc Zyngier 1953db57d746STomasz Nowicki set_handle_irq(gic_handle_irq); 1954db57d746STomasz Nowicki 19551a60e1e6SMarc Zyngier gic_update_rdist_properties(); 19560edc23eaSMarc Zyngier 1957db57d746STomasz Nowicki gic_dist_init(); 1958db57d746STomasz Nowicki gic_cpu_init(); 195964b499d8SMarc Zyngier gic_smp_init(); 1960db57d746STomasz Nowicki gic_cpu_pm_init(); 1961db57d746STomasz Nowicki 1962d38a71c5SMarc Zyngier if (gic_dist_supports_lpis()) { 1963d38a71c5SMarc Zyngier its_init(handle, &gic_data.rdists, gic_data.domain); 1964d38a71c5SMarc Zyngier its_cpu_init(); 1965d23bc2bcSValentin Schneider its_lpi_memreserve_init(); 196690b4c555SZeev Zilberman } else { 196790b4c555SZeev Zilberman if (IS_ENABLED(CONFIG_ARM_GIC_V2M)) 196890b4c555SZeev Zilberman gicv2m_init(handle, gic_data.domain); 1969d38a71c5SMarc Zyngier } 1970d38a71c5SMarc Zyngier 1971d98d0a99SJulien Thierry gic_enable_nmi_support(); 1972d98d0a99SJulien Thierry 1973db57d746STomasz Nowicki return 0; 1974db57d746STomasz Nowicki 1975db57d746STomasz Nowicki out_free: 1976db57d746STomasz Nowicki if (gic_data.domain) 1977db57d746STomasz Nowicki irq_domain_remove(gic_data.domain); 1978db57d746STomasz Nowicki free_percpu(gic_data.rdists.rdist); 1979db57d746STomasz Nowicki return err; 1980db57d746STomasz Nowicki } 1981db57d746STomasz Nowicki 1982db57d746STomasz Nowicki static int __init gic_validate_dist_version(void __iomem *dist_base) 1983db57d746STomasz Nowicki { 1984db57d746STomasz Nowicki u32 reg = readl_relaxed(dist_base + GICD_PIDR2) & GIC_PIDR2_ARCH_MASK; 1985db57d746STomasz Nowicki 1986db57d746STomasz Nowicki if (reg != GIC_PIDR2_ARCH_GICv3 && reg != GIC_PIDR2_ARCH_GICv4) 1987db57d746STomasz Nowicki return -ENODEV; 1988db57d746STomasz Nowicki 1989db57d746STomasz Nowicki return 0; 1990db57d746STomasz Nowicki } 1991db57d746STomasz Nowicki 1992e3825ba1SMarc Zyngier /* Create all possible partitions at boot time */ 19937beaa24bSLinus Torvalds static void __init gic_populate_ppi_partitions(struct device_node *gic_node) 1994e3825ba1SMarc Zyngier { 1995e3825ba1SMarc Zyngier struct device_node *parts_node, *child_part; 1996e3825ba1SMarc Zyngier int part_idx = 0, i; 1997e3825ba1SMarc Zyngier int nr_parts; 1998e3825ba1SMarc Zyngier struct partition_affinity *parts; 1999e3825ba1SMarc Zyngier 200000ee9a1cSJohan Hovold parts_node = of_get_child_by_name(gic_node, "ppi-partitions"); 2001e3825ba1SMarc Zyngier if (!parts_node) 2002e3825ba1SMarc Zyngier return; 2003e3825ba1SMarc Zyngier 200452085d3fSMarc Zyngier gic_data.ppi_descs = kcalloc(gic_data.ppi_nr, sizeof(*gic_data.ppi_descs), GFP_KERNEL); 200552085d3fSMarc Zyngier if (!gic_data.ppi_descs) 2006ec8401a4SMiaoqian Lin goto out_put_node; 200752085d3fSMarc Zyngier 2008e3825ba1SMarc Zyngier nr_parts = of_get_child_count(parts_node); 2009e3825ba1SMarc Zyngier 2010e3825ba1SMarc Zyngier if (!nr_parts) 201100ee9a1cSJohan Hovold goto out_put_node; 2012e3825ba1SMarc Zyngier 20136396bb22SKees Cook parts = kcalloc(nr_parts, sizeof(*parts), GFP_KERNEL); 2014e3825ba1SMarc Zyngier if (WARN_ON(!parts)) 201500ee9a1cSJohan Hovold goto out_put_node; 2016e3825ba1SMarc Zyngier 2017e3825ba1SMarc Zyngier for_each_child_of_node(parts_node, child_part) { 2018e3825ba1SMarc Zyngier struct partition_affinity *part; 2019e3825ba1SMarc Zyngier int n; 2020e3825ba1SMarc Zyngier 2021e3825ba1SMarc Zyngier part = &parts[part_idx]; 2022e3825ba1SMarc Zyngier 2023e3825ba1SMarc Zyngier part->partition_id = of_node_to_fwnode(child_part); 2024e3825ba1SMarc Zyngier 20252ef790dcSRob Herring pr_info("GIC: PPI partition %pOFn[%d] { ", 20262ef790dcSRob Herring child_part, part_idx); 2027e3825ba1SMarc Zyngier 2028e3825ba1SMarc Zyngier n = of_property_count_elems_of_size(child_part, "affinity", 2029e3825ba1SMarc Zyngier sizeof(u32)); 2030e3825ba1SMarc Zyngier WARN_ON(n <= 0); 2031e3825ba1SMarc Zyngier 2032e3825ba1SMarc Zyngier for (i = 0; i < n; i++) { 2033e3825ba1SMarc Zyngier int err, cpu; 2034e3825ba1SMarc Zyngier u32 cpu_phandle; 2035e3825ba1SMarc Zyngier struct device_node *cpu_node; 2036e3825ba1SMarc Zyngier 2037e3825ba1SMarc Zyngier err = of_property_read_u32_index(child_part, "affinity", 2038e3825ba1SMarc Zyngier i, &cpu_phandle); 2039e3825ba1SMarc Zyngier if (WARN_ON(err)) 2040e3825ba1SMarc Zyngier continue; 2041e3825ba1SMarc Zyngier 2042e3825ba1SMarc Zyngier cpu_node = of_find_node_by_phandle(cpu_phandle); 2043e3825ba1SMarc Zyngier if (WARN_ON(!cpu_node)) 2044e3825ba1SMarc Zyngier continue; 2045e3825ba1SMarc Zyngier 2046c08ec7daSSuzuki K Poulose cpu = of_cpu_node_to_id(cpu_node); 2047fa1ad9d4SMiaoqian Lin if (WARN_ON(cpu < 0)) { 2048fa1ad9d4SMiaoqian Lin of_node_put(cpu_node); 2049e3825ba1SMarc Zyngier continue; 2050fa1ad9d4SMiaoqian Lin } 2051e3825ba1SMarc Zyngier 2052e81f54c6SRob Herring pr_cont("%pOF[%d] ", cpu_node, cpu); 2053e3825ba1SMarc Zyngier 2054e3825ba1SMarc Zyngier cpumask_set_cpu(cpu, &part->mask); 2055fa1ad9d4SMiaoqian Lin of_node_put(cpu_node); 2056e3825ba1SMarc Zyngier } 2057e3825ba1SMarc Zyngier 2058e3825ba1SMarc Zyngier pr_cont("}\n"); 2059e3825ba1SMarc Zyngier part_idx++; 2060e3825ba1SMarc Zyngier } 2061e3825ba1SMarc Zyngier 206252085d3fSMarc Zyngier for (i = 0; i < gic_data.ppi_nr; i++) { 2063e3825ba1SMarc Zyngier unsigned int irq; 2064e3825ba1SMarc Zyngier struct partition_desc *desc; 2065e3825ba1SMarc Zyngier struct irq_fwspec ppi_fwspec = { 2066e3825ba1SMarc Zyngier .fwnode = gic_data.fwnode, 2067e3825ba1SMarc Zyngier .param_count = 3, 2068e3825ba1SMarc Zyngier .param = { 206965da7d19SMarc Zyngier [0] = GIC_IRQ_TYPE_PARTITION, 2070e3825ba1SMarc Zyngier [1] = i, 2071e3825ba1SMarc Zyngier [2] = IRQ_TYPE_NONE, 2072e3825ba1SMarc Zyngier }, 2073e3825ba1SMarc Zyngier }; 2074e3825ba1SMarc Zyngier 2075e3825ba1SMarc Zyngier irq = irq_create_fwspec_mapping(&ppi_fwspec); 2076e3825ba1SMarc Zyngier if (WARN_ON(!irq)) 2077e3825ba1SMarc Zyngier continue; 2078e3825ba1SMarc Zyngier desc = partition_create_desc(gic_data.fwnode, parts, nr_parts, 2079e3825ba1SMarc Zyngier irq, &partition_domain_ops); 2080e3825ba1SMarc Zyngier if (WARN_ON(!desc)) 2081e3825ba1SMarc Zyngier continue; 2082e3825ba1SMarc Zyngier 2083e3825ba1SMarc Zyngier gic_data.ppi_descs[i] = desc; 2084e3825ba1SMarc Zyngier } 208500ee9a1cSJohan Hovold 208600ee9a1cSJohan Hovold out_put_node: 208700ee9a1cSJohan Hovold of_node_put(parts_node); 2088e3825ba1SMarc Zyngier } 2089e3825ba1SMarc Zyngier 20901839e576SJulien Grall static void __init gic_of_setup_kvm_info(struct device_node *node) 20911839e576SJulien Grall { 20921839e576SJulien Grall int ret; 20931839e576SJulien Grall struct resource r; 20941839e576SJulien Grall u32 gicv_idx; 20951839e576SJulien Grall 20961839e576SJulien Grall gic_v3_kvm_info.type = GIC_V3; 20971839e576SJulien Grall 20981839e576SJulien Grall gic_v3_kvm_info.maint_irq = irq_of_parse_and_map(node, 0); 20991839e576SJulien Grall if (!gic_v3_kvm_info.maint_irq) 21001839e576SJulien Grall return; 21011839e576SJulien Grall 21021839e576SJulien Grall if (of_property_read_u32(node, "#redistributor-regions", 21031839e576SJulien Grall &gicv_idx)) 21041839e576SJulien Grall gicv_idx = 1; 21051839e576SJulien Grall 21061839e576SJulien Grall gicv_idx += 3; /* Also skip GICD, GICC, GICH */ 21071839e576SJulien Grall ret = of_address_to_resource(node, gicv_idx, &r); 21081839e576SJulien Grall if (!ret) 21091839e576SJulien Grall gic_v3_kvm_info.vcpu = r; 21101839e576SJulien Grall 21114bdf5025SMarc Zyngier gic_v3_kvm_info.has_v4 = gic_data.rdists.has_vlpis; 21123c40706dSMarc Zyngier gic_v3_kvm_info.has_v4_1 = gic_data.rdists.has_rvpeid; 21130e5cb777SMarc Zyngier vgic_set_kvm_info(&gic_v3_kvm_info); 21141839e576SJulien Grall } 21151839e576SJulien Grall 21164deb96e3SRobin Murphy static void gic_request_region(resource_size_t base, resource_size_t size, 21174deb96e3SRobin Murphy const char *name) 21184deb96e3SRobin Murphy { 21194deb96e3SRobin Murphy if (!request_mem_region(base, size, name)) 21204deb96e3SRobin Murphy pr_warn_once(FW_BUG "%s region %pa has overlapping address\n", 21214deb96e3SRobin Murphy name, &base); 21224deb96e3SRobin Murphy } 21234deb96e3SRobin Murphy 21244deb96e3SRobin Murphy static void __iomem *gic_of_iomap(struct device_node *node, int idx, 21254deb96e3SRobin Murphy const char *name, struct resource *res) 21264deb96e3SRobin Murphy { 21274deb96e3SRobin Murphy void __iomem *base; 21284deb96e3SRobin Murphy int ret; 21294deb96e3SRobin Murphy 21304deb96e3SRobin Murphy ret = of_address_to_resource(node, idx, res); 21314deb96e3SRobin Murphy if (ret) 21324deb96e3SRobin Murphy return IOMEM_ERR_PTR(ret); 21334deb96e3SRobin Murphy 21344deb96e3SRobin Murphy gic_request_region(res->start, resource_size(res), name); 21354deb96e3SRobin Murphy base = of_iomap(node, idx); 21364deb96e3SRobin Murphy 21374deb96e3SRobin Murphy return base ?: IOMEM_ERR_PTR(-ENOMEM); 21384deb96e3SRobin Murphy } 21394deb96e3SRobin Murphy 2140021f6537SMarc Zyngier static int __init gic_of_init(struct device_node *node, struct device_node *parent) 2141021f6537SMarc Zyngier { 2142*35727af2SShanker Donthineni phys_addr_t dist_phys_base; 2143021f6537SMarc Zyngier void __iomem *dist_base; 2144f5c1434cSMarc Zyngier struct redist_region *rdist_regs; 21454deb96e3SRobin Murphy struct resource res; 2146021f6537SMarc Zyngier u64 redist_stride; 2147f5c1434cSMarc Zyngier u32 nr_redist_regions; 2148db57d746STomasz Nowicki int err, i; 2149021f6537SMarc Zyngier 21504deb96e3SRobin Murphy dist_base = gic_of_iomap(node, 0, "GICD", &res); 21512b2cd74aSRobin Murphy if (IS_ERR(dist_base)) { 2152e81f54c6SRob Herring pr_err("%pOF: unable to map gic dist registers\n", node); 21532b2cd74aSRobin Murphy return PTR_ERR(dist_base); 2154021f6537SMarc Zyngier } 2155021f6537SMarc Zyngier 2156*35727af2SShanker Donthineni dist_phys_base = res.start; 2157*35727af2SShanker Donthineni 2158db57d746STomasz Nowicki err = gic_validate_dist_version(dist_base); 2159db57d746STomasz Nowicki if (err) { 2160e81f54c6SRob Herring pr_err("%pOF: no distributor detected, giving up\n", node); 2161021f6537SMarc Zyngier goto out_unmap_dist; 2162021f6537SMarc Zyngier } 2163021f6537SMarc Zyngier 2164f5c1434cSMarc Zyngier if (of_property_read_u32(node, "#redistributor-regions", &nr_redist_regions)) 2165f5c1434cSMarc Zyngier nr_redist_regions = 1; 2166021f6537SMarc Zyngier 21676396bb22SKees Cook rdist_regs = kcalloc(nr_redist_regions, sizeof(*rdist_regs), 21686396bb22SKees Cook GFP_KERNEL); 2169f5c1434cSMarc Zyngier if (!rdist_regs) { 2170021f6537SMarc Zyngier err = -ENOMEM; 2171021f6537SMarc Zyngier goto out_unmap_dist; 2172021f6537SMarc Zyngier } 2173021f6537SMarc Zyngier 2174f5c1434cSMarc Zyngier for (i = 0; i < nr_redist_regions; i++) { 21754deb96e3SRobin Murphy rdist_regs[i].redist_base = gic_of_iomap(node, 1 + i, "GICR", &res); 21764deb96e3SRobin Murphy if (IS_ERR(rdist_regs[i].redist_base)) { 2177e81f54c6SRob Herring pr_err("%pOF: couldn't map region %d\n", node, i); 2178021f6537SMarc Zyngier err = -ENODEV; 2179021f6537SMarc Zyngier goto out_unmap_rdist; 2180021f6537SMarc Zyngier } 2181f5c1434cSMarc Zyngier rdist_regs[i].phys_base = res.start; 2182021f6537SMarc Zyngier } 2183021f6537SMarc Zyngier 2184021f6537SMarc Zyngier if (of_property_read_u64(node, "redistributor-stride", &redist_stride)) 2185021f6537SMarc Zyngier redist_stride = 0; 2186021f6537SMarc Zyngier 2187f70fdb42SSrinivas Kandagatla gic_enable_of_quirks(node, gic_quirks, &gic_data); 2188f70fdb42SSrinivas Kandagatla 2189*35727af2SShanker Donthineni err = gic_init_bases(dist_phys_base, dist_base, rdist_regs, 2190*35727af2SShanker Donthineni nr_redist_regions, redist_stride, &node->fwnode); 2191e3825ba1SMarc Zyngier if (err) 2192e3825ba1SMarc Zyngier goto out_unmap_rdist; 2193e3825ba1SMarc Zyngier 2194e3825ba1SMarc Zyngier gic_populate_ppi_partitions(node); 2195d33a3c8cSChristoffer Dall 2196d01d3274SDavidlohr Bueso if (static_branch_likely(&supports_deactivate_key)) 21971839e576SJulien Grall gic_of_setup_kvm_info(node); 2198021f6537SMarc Zyngier return 0; 2199021f6537SMarc Zyngier 2200021f6537SMarc Zyngier out_unmap_rdist: 2201f5c1434cSMarc Zyngier for (i = 0; i < nr_redist_regions; i++) 22022b2cd74aSRobin Murphy if (rdist_regs[i].redist_base && !IS_ERR(rdist_regs[i].redist_base)) 2203f5c1434cSMarc Zyngier iounmap(rdist_regs[i].redist_base); 2204f5c1434cSMarc Zyngier kfree(rdist_regs); 2205021f6537SMarc Zyngier out_unmap_dist: 2206021f6537SMarc Zyngier iounmap(dist_base); 2207021f6537SMarc Zyngier return err; 2208021f6537SMarc Zyngier } 2209021f6537SMarc Zyngier 2210021f6537SMarc Zyngier IRQCHIP_DECLARE(gic_v3, "arm,gic-v3", gic_of_init); 2211ffa7d616STomasz Nowicki 2212ffa7d616STomasz Nowicki #ifdef CONFIG_ACPI 2213611f039fSJulien Grall static struct 2214611f039fSJulien Grall { 2215611f039fSJulien Grall void __iomem *dist_base; 2216611f039fSJulien Grall struct redist_region *redist_regs; 2217611f039fSJulien Grall u32 nr_redist_regions; 2218611f039fSJulien Grall bool single_redist; 2219926b5dfaSMarc Zyngier int enabled_rdists; 22201839e576SJulien Grall u32 maint_irq; 22211839e576SJulien Grall int maint_irq_mode; 22221839e576SJulien Grall phys_addr_t vcpu_base; 2223611f039fSJulien Grall } acpi_data __initdata; 2224b70fb7afSTomasz Nowicki 2225b70fb7afSTomasz Nowicki static void __init 2226b70fb7afSTomasz Nowicki gic_acpi_register_redist(phys_addr_t phys_base, void __iomem *redist_base) 2227b70fb7afSTomasz Nowicki { 2228b70fb7afSTomasz Nowicki static int count = 0; 2229b70fb7afSTomasz Nowicki 2230611f039fSJulien Grall acpi_data.redist_regs[count].phys_base = phys_base; 2231611f039fSJulien Grall acpi_data.redist_regs[count].redist_base = redist_base; 2232611f039fSJulien Grall acpi_data.redist_regs[count].single_redist = acpi_data.single_redist; 2233b70fb7afSTomasz Nowicki count++; 2234b70fb7afSTomasz Nowicki } 2235ffa7d616STomasz Nowicki 2236ffa7d616STomasz Nowicki static int __init 223760574d1eSKeith Busch gic_acpi_parse_madt_redist(union acpi_subtable_headers *header, 2238ffa7d616STomasz Nowicki const unsigned long end) 2239ffa7d616STomasz Nowicki { 2240ffa7d616STomasz Nowicki struct acpi_madt_generic_redistributor *redist = 2241ffa7d616STomasz Nowicki (struct acpi_madt_generic_redistributor *)header; 2242ffa7d616STomasz Nowicki void __iomem *redist_base; 2243ffa7d616STomasz Nowicki 2244ffa7d616STomasz Nowicki redist_base = ioremap(redist->base_address, redist->length); 2245ffa7d616STomasz Nowicki if (!redist_base) { 2246ffa7d616STomasz Nowicki pr_err("Couldn't map GICR region @%llx\n", redist->base_address); 2247ffa7d616STomasz Nowicki return -ENOMEM; 2248ffa7d616STomasz Nowicki } 22494deb96e3SRobin Murphy gic_request_region(redist->base_address, redist->length, "GICR"); 2250ffa7d616STomasz Nowicki 2251b70fb7afSTomasz Nowicki gic_acpi_register_redist(redist->base_address, redist_base); 2252ffa7d616STomasz Nowicki return 0; 2253ffa7d616STomasz Nowicki } 2254ffa7d616STomasz Nowicki 2255b70fb7afSTomasz Nowicki static int __init 225660574d1eSKeith Busch gic_acpi_parse_madt_gicc(union acpi_subtable_headers *header, 2257b70fb7afSTomasz Nowicki const unsigned long end) 2258b70fb7afSTomasz Nowicki { 2259b70fb7afSTomasz Nowicki struct acpi_madt_generic_interrupt *gicc = 2260b70fb7afSTomasz Nowicki (struct acpi_madt_generic_interrupt *)header; 2261611f039fSJulien Grall u32 reg = readl_relaxed(acpi_data.dist_base + GICD_PIDR2) & GIC_PIDR2_ARCH_MASK; 2262b70fb7afSTomasz Nowicki u32 size = reg == GIC_PIDR2_ARCH_GICv4 ? SZ_64K * 4 : SZ_64K * 2; 2263b70fb7afSTomasz Nowicki void __iomem *redist_base; 2264b70fb7afSTomasz Nowicki 2265ebe2f871SShanker Donthineni /* GICC entry which has !ACPI_MADT_ENABLED is not unusable so skip */ 2266ebe2f871SShanker Donthineni if (!(gicc->flags & ACPI_MADT_ENABLED)) 2267ebe2f871SShanker Donthineni return 0; 2268ebe2f871SShanker Donthineni 2269b70fb7afSTomasz Nowicki redist_base = ioremap(gicc->gicr_base_address, size); 2270b70fb7afSTomasz Nowicki if (!redist_base) 2271b70fb7afSTomasz Nowicki return -ENOMEM; 22724deb96e3SRobin Murphy gic_request_region(gicc->gicr_base_address, size, "GICR"); 2273b70fb7afSTomasz Nowicki 2274b70fb7afSTomasz Nowicki gic_acpi_register_redist(gicc->gicr_base_address, redist_base); 2275b70fb7afSTomasz Nowicki return 0; 2276b70fb7afSTomasz Nowicki } 2277b70fb7afSTomasz Nowicki 2278b70fb7afSTomasz Nowicki static int __init gic_acpi_collect_gicr_base(void) 2279b70fb7afSTomasz Nowicki { 2280b70fb7afSTomasz Nowicki acpi_tbl_entry_handler redist_parser; 2281b70fb7afSTomasz Nowicki enum acpi_madt_type type; 2282b70fb7afSTomasz Nowicki 2283611f039fSJulien Grall if (acpi_data.single_redist) { 2284b70fb7afSTomasz Nowicki type = ACPI_MADT_TYPE_GENERIC_INTERRUPT; 2285b70fb7afSTomasz Nowicki redist_parser = gic_acpi_parse_madt_gicc; 2286b70fb7afSTomasz Nowicki } else { 2287b70fb7afSTomasz Nowicki type = ACPI_MADT_TYPE_GENERIC_REDISTRIBUTOR; 2288b70fb7afSTomasz Nowicki redist_parser = gic_acpi_parse_madt_redist; 2289b70fb7afSTomasz Nowicki } 2290b70fb7afSTomasz Nowicki 2291b70fb7afSTomasz Nowicki /* Collect redistributor base addresses in GICR entries */ 2292b70fb7afSTomasz Nowicki if (acpi_table_parse_madt(type, redist_parser, 0) > 0) 2293b70fb7afSTomasz Nowicki return 0; 2294b70fb7afSTomasz Nowicki 2295b70fb7afSTomasz Nowicki pr_info("No valid GICR entries exist\n"); 2296b70fb7afSTomasz Nowicki return -ENODEV; 2297b70fb7afSTomasz Nowicki } 2298b70fb7afSTomasz Nowicki 229960574d1eSKeith Busch static int __init gic_acpi_match_gicr(union acpi_subtable_headers *header, 2300ffa7d616STomasz Nowicki const unsigned long end) 2301ffa7d616STomasz Nowicki { 2302ffa7d616STomasz Nowicki /* Subtable presence means that redist exists, that's it */ 2303ffa7d616STomasz Nowicki return 0; 2304ffa7d616STomasz Nowicki } 2305ffa7d616STomasz Nowicki 230660574d1eSKeith Busch static int __init gic_acpi_match_gicc(union acpi_subtable_headers *header, 2307b70fb7afSTomasz Nowicki const unsigned long end) 2308b70fb7afSTomasz Nowicki { 2309b70fb7afSTomasz Nowicki struct acpi_madt_generic_interrupt *gicc = 2310b70fb7afSTomasz Nowicki (struct acpi_madt_generic_interrupt *)header; 2311b70fb7afSTomasz Nowicki 2312b70fb7afSTomasz Nowicki /* 2313b70fb7afSTomasz Nowicki * If GICC is enabled and has valid gicr base address, then it means 2314b70fb7afSTomasz Nowicki * GICR base is presented via GICC 2315b70fb7afSTomasz Nowicki */ 2316926b5dfaSMarc Zyngier if ((gicc->flags & ACPI_MADT_ENABLED) && gicc->gicr_base_address) { 2317926b5dfaSMarc Zyngier acpi_data.enabled_rdists++; 2318b70fb7afSTomasz Nowicki return 0; 2319926b5dfaSMarc Zyngier } 2320b70fb7afSTomasz Nowicki 2321ebe2f871SShanker Donthineni /* 2322ebe2f871SShanker Donthineni * It's perfectly valid firmware can pass disabled GICC entry, driver 2323ebe2f871SShanker Donthineni * should not treat as errors, skip the entry instead of probe fail. 2324ebe2f871SShanker Donthineni */ 2325ebe2f871SShanker Donthineni if (!(gicc->flags & ACPI_MADT_ENABLED)) 2326ebe2f871SShanker Donthineni return 0; 2327ebe2f871SShanker Donthineni 2328b70fb7afSTomasz Nowicki return -ENODEV; 2329b70fb7afSTomasz Nowicki } 2330b70fb7afSTomasz Nowicki 2331b70fb7afSTomasz Nowicki static int __init gic_acpi_count_gicr_regions(void) 2332b70fb7afSTomasz Nowicki { 2333b70fb7afSTomasz Nowicki int count; 2334b70fb7afSTomasz Nowicki 2335b70fb7afSTomasz Nowicki /* 2336b70fb7afSTomasz Nowicki * Count how many redistributor regions we have. It is not allowed 2337b70fb7afSTomasz Nowicki * to mix redistributor description, GICR and GICC subtables have to be 2338b70fb7afSTomasz Nowicki * mutually exclusive. 2339b70fb7afSTomasz Nowicki */ 2340b70fb7afSTomasz Nowicki count = acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_REDISTRIBUTOR, 2341b70fb7afSTomasz Nowicki gic_acpi_match_gicr, 0); 2342b70fb7afSTomasz Nowicki if (count > 0) { 2343611f039fSJulien Grall acpi_data.single_redist = false; 2344b70fb7afSTomasz Nowicki return count; 2345b70fb7afSTomasz Nowicki } 2346b70fb7afSTomasz Nowicki 2347b70fb7afSTomasz Nowicki count = acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_INTERRUPT, 2348b70fb7afSTomasz Nowicki gic_acpi_match_gicc, 0); 2349926b5dfaSMarc Zyngier if (count > 0) { 2350611f039fSJulien Grall acpi_data.single_redist = true; 2351926b5dfaSMarc Zyngier count = acpi_data.enabled_rdists; 2352926b5dfaSMarc Zyngier } 2353b70fb7afSTomasz Nowicki 2354b70fb7afSTomasz Nowicki return count; 2355b70fb7afSTomasz Nowicki } 2356b70fb7afSTomasz Nowicki 2357ffa7d616STomasz Nowicki static bool __init acpi_validate_gic_table(struct acpi_subtable_header *header, 2358ffa7d616STomasz Nowicki struct acpi_probe_entry *ape) 2359ffa7d616STomasz Nowicki { 2360ffa7d616STomasz Nowicki struct acpi_madt_generic_distributor *dist; 2361ffa7d616STomasz Nowicki int count; 2362ffa7d616STomasz Nowicki 2363ffa7d616STomasz Nowicki dist = (struct acpi_madt_generic_distributor *)header; 2364ffa7d616STomasz Nowicki if (dist->version != ape->driver_data) 2365ffa7d616STomasz Nowicki return false; 2366ffa7d616STomasz Nowicki 2367ffa7d616STomasz Nowicki /* We need to do that exercise anyway, the sooner the better */ 2368b70fb7afSTomasz Nowicki count = gic_acpi_count_gicr_regions(); 2369ffa7d616STomasz Nowicki if (count <= 0) 2370ffa7d616STomasz Nowicki return false; 2371ffa7d616STomasz Nowicki 2372611f039fSJulien Grall acpi_data.nr_redist_regions = count; 2373ffa7d616STomasz Nowicki return true; 2374ffa7d616STomasz Nowicki } 2375ffa7d616STomasz Nowicki 237660574d1eSKeith Busch static int __init gic_acpi_parse_virt_madt_gicc(union acpi_subtable_headers *header, 23771839e576SJulien Grall const unsigned long end) 23781839e576SJulien Grall { 23791839e576SJulien Grall struct acpi_madt_generic_interrupt *gicc = 23801839e576SJulien Grall (struct acpi_madt_generic_interrupt *)header; 23811839e576SJulien Grall int maint_irq_mode; 23821839e576SJulien Grall static int first_madt = true; 23831839e576SJulien Grall 23841839e576SJulien Grall /* Skip unusable CPUs */ 23851839e576SJulien Grall if (!(gicc->flags & ACPI_MADT_ENABLED)) 23861839e576SJulien Grall return 0; 23871839e576SJulien Grall 23881839e576SJulien Grall maint_irq_mode = (gicc->flags & ACPI_MADT_VGIC_IRQ_MODE) ? 23891839e576SJulien Grall ACPI_EDGE_SENSITIVE : ACPI_LEVEL_SENSITIVE; 23901839e576SJulien Grall 23911839e576SJulien Grall if (first_madt) { 23921839e576SJulien Grall first_madt = false; 23931839e576SJulien Grall 23941839e576SJulien Grall acpi_data.maint_irq = gicc->vgic_interrupt; 23951839e576SJulien Grall acpi_data.maint_irq_mode = maint_irq_mode; 23961839e576SJulien Grall acpi_data.vcpu_base = gicc->gicv_base_address; 23971839e576SJulien Grall 23981839e576SJulien Grall return 0; 23991839e576SJulien Grall } 24001839e576SJulien Grall 24011839e576SJulien Grall /* 24021839e576SJulien Grall * The maintenance interrupt and GICV should be the same for every CPU 24031839e576SJulien Grall */ 24041839e576SJulien Grall if ((acpi_data.maint_irq != gicc->vgic_interrupt) || 24051839e576SJulien Grall (acpi_data.maint_irq_mode != maint_irq_mode) || 24061839e576SJulien Grall (acpi_data.vcpu_base != gicc->gicv_base_address)) 24071839e576SJulien Grall return -EINVAL; 24081839e576SJulien Grall 24091839e576SJulien Grall return 0; 24101839e576SJulien Grall } 24111839e576SJulien Grall 24121839e576SJulien Grall static bool __init gic_acpi_collect_virt_info(void) 24131839e576SJulien Grall { 24141839e576SJulien Grall int count; 24151839e576SJulien Grall 24161839e576SJulien Grall count = acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_INTERRUPT, 24171839e576SJulien Grall gic_acpi_parse_virt_madt_gicc, 0); 24181839e576SJulien Grall 24191839e576SJulien Grall return (count > 0); 24201839e576SJulien Grall } 24211839e576SJulien Grall 2422ffa7d616STomasz Nowicki #define ACPI_GICV3_DIST_MEM_SIZE (SZ_64K) 24231839e576SJulien Grall #define ACPI_GICV2_VCTRL_MEM_SIZE (SZ_4K) 24241839e576SJulien Grall #define ACPI_GICV2_VCPU_MEM_SIZE (SZ_8K) 24251839e576SJulien Grall 24261839e576SJulien Grall static void __init gic_acpi_setup_kvm_info(void) 24271839e576SJulien Grall { 24281839e576SJulien Grall int irq; 24291839e576SJulien Grall 24301839e576SJulien Grall if (!gic_acpi_collect_virt_info()) { 24311839e576SJulien Grall pr_warn("Unable to get hardware information used for virtualization\n"); 24321839e576SJulien Grall return; 24331839e576SJulien Grall } 24341839e576SJulien Grall 24351839e576SJulien Grall gic_v3_kvm_info.type = GIC_V3; 24361839e576SJulien Grall 24371839e576SJulien Grall irq = acpi_register_gsi(NULL, acpi_data.maint_irq, 24381839e576SJulien Grall acpi_data.maint_irq_mode, 24391839e576SJulien Grall ACPI_ACTIVE_HIGH); 24401839e576SJulien Grall if (irq <= 0) 24411839e576SJulien Grall return; 24421839e576SJulien Grall 24431839e576SJulien Grall gic_v3_kvm_info.maint_irq = irq; 24441839e576SJulien Grall 24451839e576SJulien Grall if (acpi_data.vcpu_base) { 24461839e576SJulien Grall struct resource *vcpu = &gic_v3_kvm_info.vcpu; 24471839e576SJulien Grall 24481839e576SJulien Grall vcpu->flags = IORESOURCE_MEM; 24491839e576SJulien Grall vcpu->start = acpi_data.vcpu_base; 24501839e576SJulien Grall vcpu->end = vcpu->start + ACPI_GICV2_VCPU_MEM_SIZE - 1; 24511839e576SJulien Grall } 24521839e576SJulien Grall 24534bdf5025SMarc Zyngier gic_v3_kvm_info.has_v4 = gic_data.rdists.has_vlpis; 24543c40706dSMarc Zyngier gic_v3_kvm_info.has_v4_1 = gic_data.rdists.has_rvpeid; 24550e5cb777SMarc Zyngier vgic_set_kvm_info(&gic_v3_kvm_info); 24561839e576SJulien Grall } 2457ffa7d616STomasz Nowicki 24587327b16fSMarc Zyngier static struct fwnode_handle *gsi_domain_handle; 24597327b16fSMarc Zyngier 24607327b16fSMarc Zyngier static struct fwnode_handle *gic_v3_get_gsi_domain_id(u32 gsi) 24617327b16fSMarc Zyngier { 24627327b16fSMarc Zyngier return gsi_domain_handle; 24637327b16fSMarc Zyngier } 24647327b16fSMarc Zyngier 2465ffa7d616STomasz Nowicki static int __init 2466aba3c7edSOscar Carter gic_acpi_init(union acpi_subtable_headers *header, const unsigned long end) 2467ffa7d616STomasz Nowicki { 2468ffa7d616STomasz Nowicki struct acpi_madt_generic_distributor *dist; 2469611f039fSJulien Grall size_t size; 2470b70fb7afSTomasz Nowicki int i, err; 2471ffa7d616STomasz Nowicki 2472ffa7d616STomasz Nowicki /* Get distributor base address */ 2473ffa7d616STomasz Nowicki dist = (struct acpi_madt_generic_distributor *)header; 2474611f039fSJulien Grall acpi_data.dist_base = ioremap(dist->base_address, 2475611f039fSJulien Grall ACPI_GICV3_DIST_MEM_SIZE); 2476611f039fSJulien Grall if (!acpi_data.dist_base) { 2477ffa7d616STomasz Nowicki pr_err("Unable to map GICD registers\n"); 2478ffa7d616STomasz Nowicki return -ENOMEM; 2479ffa7d616STomasz Nowicki } 24804deb96e3SRobin Murphy gic_request_region(dist->base_address, ACPI_GICV3_DIST_MEM_SIZE, "GICD"); 2481ffa7d616STomasz Nowicki 2482611f039fSJulien Grall err = gic_validate_dist_version(acpi_data.dist_base); 2483ffa7d616STomasz Nowicki if (err) { 248471192a68SArvind Yadav pr_err("No distributor detected at @%p, giving up\n", 2485611f039fSJulien Grall acpi_data.dist_base); 2486ffa7d616STomasz Nowicki goto out_dist_unmap; 2487ffa7d616STomasz Nowicki } 2488ffa7d616STomasz Nowicki 2489611f039fSJulien Grall size = sizeof(*acpi_data.redist_regs) * acpi_data.nr_redist_regions; 2490611f039fSJulien Grall acpi_data.redist_regs = kzalloc(size, GFP_KERNEL); 2491611f039fSJulien Grall if (!acpi_data.redist_regs) { 2492ffa7d616STomasz Nowicki err = -ENOMEM; 2493ffa7d616STomasz Nowicki goto out_dist_unmap; 2494ffa7d616STomasz Nowicki } 2495ffa7d616STomasz Nowicki 2496b70fb7afSTomasz Nowicki err = gic_acpi_collect_gicr_base(); 2497b70fb7afSTomasz Nowicki if (err) 2498ffa7d616STomasz Nowicki goto out_redist_unmap; 2499ffa7d616STomasz Nowicki 25007327b16fSMarc Zyngier gsi_domain_handle = irq_domain_alloc_fwnode(&dist->base_address); 25017327b16fSMarc Zyngier if (!gsi_domain_handle) { 2502ffa7d616STomasz Nowicki err = -ENOMEM; 2503ffa7d616STomasz Nowicki goto out_redist_unmap; 2504ffa7d616STomasz Nowicki } 2505ffa7d616STomasz Nowicki 2506*35727af2SShanker Donthineni err = gic_init_bases(dist->base_address, acpi_data.dist_base, 2507*35727af2SShanker Donthineni acpi_data.redist_regs, acpi_data.nr_redist_regions, 2508*35727af2SShanker Donthineni 0, gsi_domain_handle); 2509ffa7d616STomasz Nowicki if (err) 2510ffa7d616STomasz Nowicki goto out_fwhandle_free; 2511ffa7d616STomasz Nowicki 25127327b16fSMarc Zyngier acpi_set_irq_model(ACPI_IRQ_MODEL_GIC, gic_v3_get_gsi_domain_id); 2513d33a3c8cSChristoffer Dall 2514d01d3274SDavidlohr Bueso if (static_branch_likely(&supports_deactivate_key)) 25151839e576SJulien Grall gic_acpi_setup_kvm_info(); 25161839e576SJulien Grall 2517ffa7d616STomasz Nowicki return 0; 2518ffa7d616STomasz Nowicki 2519ffa7d616STomasz Nowicki out_fwhandle_free: 25207327b16fSMarc Zyngier irq_domain_free_fwnode(gsi_domain_handle); 2521ffa7d616STomasz Nowicki out_redist_unmap: 2522611f039fSJulien Grall for (i = 0; i < acpi_data.nr_redist_regions; i++) 2523611f039fSJulien Grall if (acpi_data.redist_regs[i].redist_base) 2524611f039fSJulien Grall iounmap(acpi_data.redist_regs[i].redist_base); 2525611f039fSJulien Grall kfree(acpi_data.redist_regs); 2526ffa7d616STomasz Nowicki out_dist_unmap: 2527611f039fSJulien Grall iounmap(acpi_data.dist_base); 2528ffa7d616STomasz Nowicki return err; 2529ffa7d616STomasz Nowicki } 2530ffa7d616STomasz Nowicki IRQCHIP_ACPI_DECLARE(gic_v3, ACPI_MADT_TYPE_GENERIC_DISTRIBUTOR, 2531ffa7d616STomasz Nowicki acpi_validate_gic_table, ACPI_MADT_GIC_VERSION_V3, 2532ffa7d616STomasz Nowicki gic_acpi_init); 2533ffa7d616STomasz Nowicki IRQCHIP_ACPI_DECLARE(gic_v4, ACPI_MADT_TYPE_GENERIC_DISTRIBUTOR, 2534ffa7d616STomasz Nowicki acpi_validate_gic_table, ACPI_MADT_GIC_VERSION_V4, 2535ffa7d616STomasz Nowicki gic_acpi_init); 2536ffa7d616STomasz Nowicki IRQCHIP_ACPI_DECLARE(gic_v3_or_v4, ACPI_MADT_TYPE_GENERIC_DISTRIBUTOR, 2537ffa7d616STomasz Nowicki acpi_validate_gic_table, ACPI_MADT_GIC_VERSION_NONE, 2538ffa7d616STomasz Nowicki gic_acpi_init); 2539ffa7d616STomasz Nowicki #endif 2540