Commit 3cb66535 authored by Linus Torvalds's avatar Linus Torvalds

Merge branch 'irq-core-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/tip/tip

Pull irq updates from Thomas Gleixner:
 "Nothing exciting from the irq side for this merge window:

   - a new driver for a Mediatek SoC

   - ACPI support for ARM GICV3

   - support for shared nested interrupts

   - the usual pile of fixes and updates all over te place"

* 'irq-core-for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/tip/tip: (28 commits)
  irqchip/mbigen: Fix return value check in mbigen_device_probe()
  irqchip/mips-gic: Replace static map with dynamic
  irqchip/mips-gic: Remove device IRQ domain
  irqchip/mips-gic: Separate IPI reservation & usage tracking
  genirq: Use irqd_get_trigger_type to compare the trigger type for shared IRQs
  genirq: Use cpumask_available() for check of cpumask variable
  cpumask: Add helper cpumask_available()
  irqchip/irq-imx-gpcv2: Clear OF_POPULATED flag
  irqchip/atmel-aic5: Handle suspend to RAM
  irqchip: Add Mediatek mtk-cirq driver
  dt-bindings: mtk-cirq: Add binding document
  irqchip/gic-v3-its: Add IORT hook for platform MSI support
  irqchip/mbigen: Add ACPI support
  irqchip/mbigen: Introduce mbigen_of_create_domain()
  irqchip/mbigen: Drop module owner
  platform-msi: Make platform_msi_create_device_domain() ACPI aware
  irqchip/gicv3-its: platform-msi: Scan MADT to create platform msi domain
  irqchip/gicv3-its: platform-msi: Refactor its_pmsi_init() to prepare for ACPI
  irqchip/gicv3-its: platform-msi: Refactor its_pmsi_prepare()
  irqchip/gic-v3-its: Keep the include header files in alphabetic order
  ...
parents 2dbf3d5c 216646e4
* Cortina Systems Gemini interrupt controller * Faraday Technologt FTINTC010 interrupt controller
This interrupt controller is found on the Gemini SoCs. This interrupt controller is a stock IP block from Faraday Technology found
in the Gemini SoCs and other designs.
Required properties: Required properties:
- compatible: must be "cortina,gemini-interrupt-controller" - compatible: must be one of
"faraday,ftintc010"
"cortina,gemini-interrupt-controller" (deprecated)
- reg: The register bank for the interrupt controller. - reg: The register bank for the interrupt controller.
- interrupt-controller: Identifies the node as an interrupt controller - interrupt-controller: Identifies the node as an interrupt controller
- #interrupt-cells: The number of cells to define the interrupts. - #interrupt-cells: The number of cells to define the interrupts.
...@@ -15,7 +18,7 @@ Required properties: ...@@ -15,7 +18,7 @@ Required properties:
Example: Example:
interrupt-controller@48000000 { interrupt-controller@48000000 {
compatible = "cortina,gemini-interrupt-controller"; compatible = "faraday,ftintc010"
reg = <0x48000000 0x1000>; reg = <0x48000000 0x1000>;
interrupt-controller; interrupt-controller;
#interrupt-cells = <2>; #interrupt-cells = <2>;
......
* Mediatek 27xx cirq
In Mediatek SOCs, the CIRQ is a low power interrupt controller designed to
work outside MCUSYS which comprises with Cortex-Ax cores,CCI and GIC.
The external interrupts (outside MCUSYS) will feed through CIRQ and connect
to GIC in MCUSYS. When CIRQ is enabled, it will record the edge-sensitive
interrupts and generate a pulse signal to parent interrupt controller when
flush command is executed. With CIRQ, MCUSYS can be completely turned off
to improve the system power consumption without losing interrupts.
Required properties:
- compatible: should be one of
- "mediatek,mt2701-cirq" for mt2701 CIRQ
- "mediatek,mt8135-cirq" for mt8135 CIRQ
- "mediatek,mt8173-cirq" for mt8173 CIRQ
and "mediatek,cirq" as a fallback.
- interrupt-controller : Identifies the node as an interrupt controller.
- #interrupt-cells : Use the same format as specified by GIC in arm,gic.txt.
- interrupt-parent: phandle of irq parent for cirq. The parent must
use the same interrupt-cells format as GIC.
- reg: Physical base address of the cirq registers and length of memory
mapped region.
- mediatek,ext-irq-range: Identifies external irq number range in different
SOCs.
Example:
cirq: interrupt-controller@10204000 {
compatible = "mediatek,mt2701-cirq",
"mediatek,mtk-cirq";
interrupt-controller;
#interrupt-cells = <3>;
interrupt-parent = <&sysirq>;
reg = <0 0x10204000 0 0x400>;
mediatek,ext-irq-start = <32 200>;
};
...@@ -21,13 +21,16 @@ Required properties: ...@@ -21,13 +21,16 @@ Required properties:
- interrupt-parent: phandle of irq parent for sysirq. The parent must - interrupt-parent: phandle of irq parent for sysirq. The parent must
use the same interrupt-cells format as GIC. use the same interrupt-cells format as GIC.
- reg: Physical base address of the intpol registers and length of memory - reg: Physical base address of the intpol registers and length of memory
mapped region. mapped region. Could be multiple bases here. Ex: mt6797 needs 2 reg, others
need 1.
Example: Example:
sysirq: interrupt-controller@10200100 { sysirq: intpol-controller@10200620 {
compatible = "mediatek,mt6589-sysirq", "mediatek,mt6577-sysirq"; compatible = "mediatek,mt6797-sysirq",
"mediatek,mt6577-sysirq";
interrupt-controller; interrupt-controller;
#interrupt-cells = <3>; #interrupt-cells = <3>;
interrupt-parent = <&gic>; interrupt-parent = <&gic>;
reg = <0 0x10200100 0 0x1c>; reg = <0 0x10220620 0 0x20>,
<0 0x10220690 0 0x10>;
}; };
...@@ -3,8 +3,8 @@ menuconfig ARCH_MOXART ...@@ -3,8 +3,8 @@ menuconfig ARCH_MOXART
depends on ARCH_MULTI_V4 depends on ARCH_MULTI_V4
select CPU_FA526 select CPU_FA526
select ARM_DMA_MEM_BUFFERABLE select ARM_DMA_MEM_BUFFERABLE
select FARADAY_FTINTC010
select MOXART_TIMER select MOXART_TIMER
select GENERIC_IRQ_CHIP
select GPIOLIB select GPIOLIB
select PHYLIB if NETDEVICES select PHYLIB if NETDEVICES
help help
......
...@@ -345,8 +345,7 @@ platform_msi_create_device_domain(struct device *dev, ...@@ -345,8 +345,7 @@ platform_msi_create_device_domain(struct device *dev,
data->host_data = host_data; data->host_data = host_data;
domain = irq_domain_create_hierarchy(dev->msi_domain, 0, nvec, domain = irq_domain_create_hierarchy(dev->msi_domain, 0, nvec,
of_node_to_fwnode(dev->of_node), dev->fwnode, ops, data);
ops, data);
if (!domain) if (!domain)
goto free_priv; goto free_priv;
......
...@@ -115,6 +115,12 @@ config DW_APB_ICTL ...@@ -115,6 +115,12 @@ config DW_APB_ICTL
select GENERIC_IRQ_CHIP select GENERIC_IRQ_CHIP
select IRQ_DOMAIN select IRQ_DOMAIN
config FARADAY_FTINTC010
bool
select IRQ_DOMAIN
select MULTI_IRQ_HANDLER
select SPARSE_IRQ
config HISILICON_IRQ_MBIGEN config HISILICON_IRQ_MBIGEN
bool bool
select ARM_GIC_V3 select ARM_GIC_V3
......
...@@ -6,7 +6,7 @@ obj-$(CONFIG_ATH79) += irq-ath79-misc.o ...@@ -6,7 +6,7 @@ obj-$(CONFIG_ATH79) += irq-ath79-misc.o
obj-$(CONFIG_ARCH_BCM2835) += irq-bcm2835.o obj-$(CONFIG_ARCH_BCM2835) += irq-bcm2835.o
obj-$(CONFIG_ARCH_BCM2835) += irq-bcm2836.o obj-$(CONFIG_ARCH_BCM2835) += irq-bcm2836.o
obj-$(CONFIG_ARCH_EXYNOS) += exynos-combiner.o obj-$(CONFIG_ARCH_EXYNOS) += exynos-combiner.o
obj-$(CONFIG_ARCH_GEMINI) += irq-gemini.o obj-$(CONFIG_FARADAY_FTINTC010) += irq-ftintc010.o
obj-$(CONFIG_ARCH_HIP04) += irq-hip04.o obj-$(CONFIG_ARCH_HIP04) += irq-hip04.o
obj-$(CONFIG_ARCH_LPC32XX) += irq-lpc32xx.o obj-$(CONFIG_ARCH_LPC32XX) += irq-lpc32xx.o
obj-$(CONFIG_ARCH_MMP) += irq-mmp.o obj-$(CONFIG_ARCH_MMP) += irq-mmp.o
...@@ -16,7 +16,6 @@ obj-$(CONFIG_ARCH_S3C24XX) += irq-s3c24xx.o ...@@ -16,7 +16,6 @@ obj-$(CONFIG_ARCH_S3C24XX) += irq-s3c24xx.o
obj-$(CONFIG_DW_APB_ICTL) += irq-dw-apb-ictl.o obj-$(CONFIG_DW_APB_ICTL) += irq-dw-apb-ictl.o
obj-$(CONFIG_METAG) += irq-metag-ext.o obj-$(CONFIG_METAG) += irq-metag-ext.o
obj-$(CONFIG_METAG_PERFCOUNTER_IRQS) += irq-metag.o obj-$(CONFIG_METAG_PERFCOUNTER_IRQS) += irq-metag.o
obj-$(CONFIG_ARCH_MOXART) += irq-moxart.o
obj-$(CONFIG_CLPS711X_IRQCHIP) += irq-clps711x.o obj-$(CONFIG_CLPS711X_IRQCHIP) += irq-clps711x.o
obj-$(CONFIG_OR1K_PIC) += irq-or1k-pic.o obj-$(CONFIG_OR1K_PIC) += irq-or1k-pic.o
obj-$(CONFIG_ORION_IRQCHIP) += irq-orion.o obj-$(CONFIG_ORION_IRQCHIP) += irq-orion.o
...@@ -62,7 +61,7 @@ obj-$(CONFIG_BCM7120_L2_IRQ) += irq-bcm7120-l2.o ...@@ -62,7 +61,7 @@ obj-$(CONFIG_BCM7120_L2_IRQ) += irq-bcm7120-l2.o
obj-$(CONFIG_BRCMSTB_L2_IRQ) += irq-brcmstb-l2.o obj-$(CONFIG_BRCMSTB_L2_IRQ) += irq-brcmstb-l2.o
obj-$(CONFIG_KEYSTONE_IRQ) += irq-keystone.o obj-$(CONFIG_KEYSTONE_IRQ) += irq-keystone.o
obj-$(CONFIG_MIPS_GIC) += irq-mips-gic.o obj-$(CONFIG_MIPS_GIC) += irq-mips-gic.o
obj-$(CONFIG_ARCH_MEDIATEK) += irq-mtk-sysirq.o obj-$(CONFIG_ARCH_MEDIATEK) += irq-mtk-sysirq.o irq-mtk-cirq.o
obj-$(CONFIG_ARCH_DIGICOLOR) += irq-digicolor.o obj-$(CONFIG_ARCH_DIGICOLOR) += irq-digicolor.o
obj-$(CONFIG_RENESAS_H8300H_INTC) += irq-renesas-h8300h.o obj-$(CONFIG_RENESAS_H8300H_INTC) += irq-renesas-h8300h.o
obj-$(CONFIG_RENESAS_H8S_INTC) += irq-renesas-h8s.o obj-$(CONFIG_RENESAS_H8S_INTC) += irq-renesas-h8s.o
......
...@@ -150,6 +150,8 @@ static int aic5_set_type(struct irq_data *d, unsigned type) ...@@ -150,6 +150,8 @@ static int aic5_set_type(struct irq_data *d, unsigned type)
} }
#ifdef CONFIG_PM #ifdef CONFIG_PM
static u32 *smr_cache;
static void aic5_suspend(struct irq_data *d) static void aic5_suspend(struct irq_data *d)
{ {
struct irq_domain *domain = d->domain; struct irq_domain *domain = d->domain;
...@@ -159,6 +161,12 @@ static void aic5_suspend(struct irq_data *d) ...@@ -159,6 +161,12 @@ static void aic5_suspend(struct irq_data *d)
int i; int i;
u32 mask; u32 mask;
if (smr_cache)
for (i = 0; i < domain->revmap_size; i++) {
irq_reg_writel(bgc, i, AT91_AIC5_SSR);
smr_cache[i] = irq_reg_readl(bgc, AT91_AIC5_SMR);
}
irq_gc_lock(bgc); irq_gc_lock(bgc);
for (i = 0; i < dgc->irqs_per_chip; i++) { for (i = 0; i < dgc->irqs_per_chip; i++) {
mask = 1 << i; mask = 1 << i;
...@@ -184,9 +192,21 @@ static void aic5_resume(struct irq_data *d) ...@@ -184,9 +192,21 @@ static void aic5_resume(struct irq_data *d)
u32 mask; u32 mask;
irq_gc_lock(bgc); irq_gc_lock(bgc);
if (smr_cache) {
irq_reg_writel(bgc, 0xffffffff, AT91_AIC5_SPU);
for (i = 0; i < domain->revmap_size; i++) {
irq_reg_writel(bgc, i, AT91_AIC5_SSR);
irq_reg_writel(bgc, i, AT91_AIC5_SVR);
irq_reg_writel(bgc, smr_cache[i], AT91_AIC5_SMR);
}
}
for (i = 0; i < dgc->irqs_per_chip; i++) { for (i = 0; i < dgc->irqs_per_chip; i++) {
mask = 1 << i; mask = 1 << i;
if ((mask & gc->mask_cache) == (mask & gc->wake_active))
if (!smr_cache &&
((mask & gc->mask_cache) == (mask & gc->wake_active)))
continue; continue;
irq_reg_writel(bgc, i + gc->irq_base, AT91_AIC5_SSR); irq_reg_writel(bgc, i + gc->irq_base, AT91_AIC5_SSR);
...@@ -342,6 +362,13 @@ static int __init aic5_of_init(struct device_node *node, ...@@ -342,6 +362,13 @@ static int __init aic5_of_init(struct device_node *node,
static int __init sama5d2_aic5_of_init(struct device_node *node, static int __init sama5d2_aic5_of_init(struct device_node *node,
struct device_node *parent) struct device_node *parent)
{ {
#ifdef CONFIG_PM
smr_cache = kcalloc(DIV_ROUND_UP(NR_SAMA5D2_IRQS, 32) * 32,
sizeof(*smr_cache), GFP_KERNEL);
if (!smr_cache)
return -ENOMEM;
#endif
return aic5_of_init(node, parent, NR_SAMA5D2_IRQS); return aic5_of_init(node, parent, NR_SAMA5D2_IRQS);
} }
IRQCHIP_DECLARE(sama5d2_aic5, "atmel,sama5d2-aic", sama5d2_aic5_of_init); IRQCHIP_DECLARE(sama5d2_aic5, "atmel,sama5d2-aic", sama5d2_aic5_of_init);
......
/* /*
* irqchip for the Cortina Systems Gemini Copyright (C) 2017 Linus * irqchip for the Faraday Technology FTINTC010 Copyright (C) 2017 Linus
* Walleij <linus.walleij@linaro.org> * Walleij <linus.walleij@linaro.org>
* *
* Based on arch/arm/mach-gemini/irq.c * Based on arch/arm/mach-gemini/irq.c
* Copyright (C) 2001-2006 Storlink, Corp. * Copyright (C) 2001-2006 Storlink, Corp.
* Copyright (C) 2008-2009 Paulius Zaleckas <paulius.zaleckas@teltonika.lt> * Copyright (C) 2008-2009 Paulius Zaleckas <paulius.zaleckas@gmail.com>
*/ */
#include <linux/bitops.h> #include <linux/bitops.h>
#include <linux/irq.h> #include <linux/irq.h>
...@@ -21,146 +21,151 @@ ...@@ -21,146 +21,151 @@
#include <asm/exception.h> #include <asm/exception.h>
#include <asm/mach/irq.h> #include <asm/mach/irq.h>
#define GEMINI_NUM_IRQS 32 #define FT010_NUM_IRQS 32
#define GEMINI_IRQ_SOURCE(base_addr) (base_addr + 0x00) #define FT010_IRQ_SOURCE(base_addr) (base_addr + 0x00)
#define GEMINI_IRQ_MASK(base_addr) (base_addr + 0x04) #define FT010_IRQ_MASK(base_addr) (base_addr + 0x04)
#define GEMINI_IRQ_CLEAR(base_addr) (base_addr + 0x08) #define FT010_IRQ_CLEAR(base_addr) (base_addr + 0x08)
#define GEMINI_IRQ_MODE(base_addr) (base_addr + 0x0C) /* Selects level- or edge-triggered */
#define GEMINI_IRQ_POLARITY(base_addr) (base_addr + 0x10) #define FT010_IRQ_MODE(base_addr) (base_addr + 0x0C)
#define GEMINI_IRQ_STATUS(base_addr) (base_addr + 0x14) /* Selects active low/high or falling/rising edge */
#define GEMINI_FIQ_SOURCE(base_addr) (base_addr + 0x20) #define FT010_IRQ_POLARITY(base_addr) (base_addr + 0x10)
#define GEMINI_FIQ_MASK(base_addr) (base_addr + 0x24) #define FT010_IRQ_STATUS(base_addr) (base_addr + 0x14)
#define GEMINI_FIQ_CLEAR(base_addr) (base_addr + 0x28) #define FT010_FIQ_SOURCE(base_addr) (base_addr + 0x20)
#define GEMINI_FIQ_MODE(base_addr) (base_addr + 0x2C) #define FT010_FIQ_MASK(base_addr) (base_addr + 0x24)
#define GEMINI_FIQ_POLARITY(base_addr) (base_addr + 0x30) #define FT010_FIQ_CLEAR(base_addr) (base_addr + 0x28)
#define GEMINI_FIQ_STATUS(base_addr) (base_addr + 0x34) #define FT010_FIQ_MODE(base_addr) (base_addr + 0x2C)
#define FT010_FIQ_POLARITY(base_addr) (base_addr + 0x30)
#define FT010_FIQ_STATUS(base_addr) (base_addr + 0x34)
/** /**
* struct gemini_irq_data - irq data container for the Gemini IRQ controller * struct ft010_irq_data - irq data container for the Faraday IRQ controller
* @base: memory offset in virtual memory * @base: memory offset in virtual memory
* @chip: chip container for this instance * @chip: chip container for this instance
* @domain: IRQ domain for this instance * @domain: IRQ domain for this instance
*/ */
struct gemini_irq_data { struct ft010_irq_data {
void __iomem *base; void __iomem *base;
struct irq_chip chip; struct irq_chip chip;
struct irq_domain *domain; struct irq_domain *domain;
}; };
static void gemini_irq_mask(struct irq_data *d) static void ft010_irq_mask(struct irq_data *d)
{ {
struct gemini_irq_data *g = irq_data_get_irq_chip_data(d); struct ft010_irq_data *f = irq_data_get_irq_chip_data(d);
unsigned int mask; unsigned int mask;
mask = readl(GEMINI_IRQ_MASK(g->base)); mask = readl(FT010_IRQ_MASK(f->base));
mask &= ~BIT(irqd_to_hwirq(d)); mask &= ~BIT(irqd_to_hwirq(d));
writel(mask, GEMINI_IRQ_MASK(g->base)); writel(mask, FT010_IRQ_MASK(f->base));
} }
static void gemini_irq_unmask(struct irq_data *d) static void ft010_irq_unmask(struct irq_data *d)
{ {
struct gemini_irq_data *g = irq_data_get_irq_chip_data(d); struct ft010_irq_data *f = irq_data_get_irq_chip_data(d);
unsigned int mask; unsigned int mask;
mask = readl(GEMINI_IRQ_MASK(g->base)); mask = readl(FT010_IRQ_MASK(f->base));
mask |= BIT(irqd_to_hwirq(d)); mask |= BIT(irqd_to_hwirq(d));
writel(mask, GEMINI_IRQ_MASK(g->base)); writel(mask, FT010_IRQ_MASK(f->base));
} }
static void gemini_irq_ack(struct irq_data *d) static void ft010_irq_ack(struct irq_data *d)
{ {
struct gemini_irq_data *g = irq_data_get_irq_chip_data(d); struct ft010_irq_data *f = irq_data_get_irq_chip_data(d);
writel(BIT(irqd_to_hwirq(d)), GEMINI_IRQ_CLEAR(g->base)); writel(BIT(irqd_to_hwirq(d)), FT010_IRQ_CLEAR(f->base));
} }
static int gemini_irq_set_type(struct irq_data *d, unsigned int trigger) static int ft010_irq_set_type(struct irq_data *d, unsigned int trigger)
{ {
struct gemini_irq_data *g = irq_data_get_irq_chip_data(d); struct ft010_irq_data *f = irq_data_get_irq_chip_data(d);
int offset = irqd_to_hwirq(d); int offset = irqd_to_hwirq(d);
u32 mode, polarity; u32 mode, polarity;
mode = readl(GEMINI_IRQ_MODE(g->base)); mode = readl(FT010_IRQ_MODE(f->base));
polarity = readl(GEMINI_IRQ_POLARITY(g->base)); polarity = readl(FT010_IRQ_POLARITY(f->base));
if (trigger & (IRQ_TYPE_LEVEL_HIGH)) { if (trigger & (IRQ_TYPE_LEVEL_LOW)) {
irq_set_handler_locked(d, handle_level_irq);
mode &= ~BIT(offset);
polarity |= BIT(offset);
} else if (trigger & (IRQ_TYPE_LEVEL_HIGH)) {
irq_set_handler_locked(d, handle_level_irq); irq_set_handler_locked(d, handle_level_irq);
/* Disable edge detection */
mode &= ~BIT(offset); mode &= ~BIT(offset);
polarity &= ~BIT(offset); polarity &= ~BIT(offset);
} else if (trigger & IRQ_TYPE_EDGE_RISING) { } else if (trigger & IRQ_TYPE_EDGE_FALLING) {
irq_set_handler_locked(d, handle_edge_irq); irq_set_handler_locked(d, handle_edge_irq);
mode |= BIT(offset); mode |= BIT(offset);
polarity |= BIT(offset); polarity |= BIT(offset);
} else if (trigger & IRQ_TYPE_EDGE_FALLING) { } else if (trigger & IRQ_TYPE_EDGE_RISING) {
irq_set_handler_locked(d, handle_edge_irq); irq_set_handler_locked(d, handle_edge_irq);
mode |= BIT(offset); mode |= BIT(offset);
polarity &= ~BIT(offset); polarity &= ~BIT(offset);
} else { } else {
irq_set_handler_locked(d, handle_bad_irq); irq_set_handler_locked(d, handle_bad_irq);
pr_warn("GEMINI IRQ: no supported trigger selected for line %d\n", pr_warn("Faraday IRQ: no supported trigger selected for line %d\n",
offset); offset);
} }
writel(mode, GEMINI_IRQ_MODE(g->base)); writel(mode, FT010_IRQ_MODE(f->base));
writel(polarity, GEMINI_IRQ_POLARITY(g->base)); writel(polarity, FT010_IRQ_POLARITY(f->base));
return 0; return 0;
} }
static struct irq_chip gemini_irq_chip = { static struct irq_chip ft010_irq_chip = {
.name = "GEMINI", .name = "FTINTC010",
.irq_ack = gemini_irq_ack, .irq_ack = ft010_irq_ack,
.irq_mask = gemini_irq_mask, .irq_mask = ft010_irq_mask,
.irq_unmask = gemini_irq_unmask, .irq_unmask = ft010_irq_unmask,
.irq_set_type = gemini_irq_set_type, .irq_set_type = ft010_irq_set_type,
}; };
/* Local static for the IRQ entry call */ /* Local static for the IRQ entry call */
static struct gemini_irq_data girq; static struct ft010_irq_data firq;
asmlinkage void __exception_irq_entry gemini_irqchip_handle_irq(struct pt_regs *regs) asmlinkage void __exception_irq_entry ft010_irqchip_handle_irq(struct pt_regs *regs)
{ {
struct gemini_irq_data *g = &girq; struct ft010_irq_data *f = &firq;
int irq; int irq;
u32 status; u32 status;
while ((status = readl(GEMINI_IRQ_STATUS(g->base)))) { while ((status = readl(FT010_IRQ_STATUS(f->base)))) {
irq = ffs(status) - 1; irq = ffs(status) - 1;
handle_domain_irq(g->domain, irq, regs); handle_domain_irq(f->domain, irq, regs);
} }
} }
static int gemini_irqdomain_map(struct irq_domain *d, unsigned int irq, static int ft010_irqdomain_map(struct irq_domain *d, unsigned int irq,
irq_hw_number_t hwirq) irq_hw_number_t hwirq)
{ {
struct gemini_irq_data *g = d->host_data; struct ft010_irq_data *f = d->host_data;
irq_set_chip_data(irq, g); irq_set_chip_data(irq, f);
/* All IRQs should set up their type, flags as bad by default */ /* All IRQs should set up their type, flags as bad by default */
irq_set_chip_and_handler(irq, &gemini_irq_chip, handle_bad_irq); irq_set_chip_and_handler(irq, &ft010_irq_chip, handle_bad_irq);
irq_set_probe(irq); irq_set_probe(irq);
return 0; return 0;
} }
static void gemini_irqdomain_unmap(struct irq_domain *d, unsigned int irq) static void ft010_irqdomain_unmap(struct irq_domain *d, unsigned int irq)
{ {
irq_set_chip_and_handler(irq, NULL, NULL); irq_set_chip_and_handler(irq, NULL, NULL);
irq_set_chip_data(irq, NULL); irq_set_chip_data(irq, NULL);
} }
static const struct irq_domain_ops gemini_irqdomain_ops = { static const struct irq_domain_ops ft010_irqdomain_ops = {
.map = gemini_irqdomain_map, .map = ft010_irqdomain_map,
.unmap = gemini_irqdomain_unmap, .unmap = ft010_irqdomain_unmap,
.xlate = irq_domain_xlate_onetwocell, .xlate = irq_domain_xlate_onetwocell,
}; };
int __init gemini_of_init_irq(struct device_node *node, int __init ft010_of_init_irq(struct device_node *node,
struct device_node *parent) struct device_node *parent)
{ {
struct gemini_irq_data *g = &girq; struct ft010_irq_data *f = &firq;
/* /*
* Disable the idle handler by default since it is buggy * Disable the idle handler by default since it is buggy
...@@ -168,18 +173,22 @@ int __init gemini_of_init_irq(struct device_node *node, ...@@ -168,18 +173,22 @@ int __init gemini_of_init_irq(struct device_node *node,
*/ */
cpu_idle_poll_ctrl(true); cpu_idle_poll_ctrl(true);
g->base = of_iomap(node, 0); f->base = of_iomap(node, 0);
WARN(!g->base, "unable to map gemini irq registers\n"); WARN(!f->base, "unable to map gemini irq registers\n");
/* Disable all interrupts */ /* Disable all interrupts */
writel(0, GEMINI_IRQ_MASK(g->base)); writel(0, FT010_IRQ_MASK(f->base));
writel(0, GEMINI_FIQ_MASK(g->base)); writel(0, FT010_FIQ_MASK(f->base));
g->domain = irq_domain_add_simple(node, GEMINI_NUM_IRQS, 0, f->domain = irq_domain_add_simple(node, FT010_NUM_IRQS, 0,
&gemini_irqdomain_ops, g); &ft010_irqdomain_ops, f);
set_handle_irq(gemini_irqchip_handle_irq); set_handle_irq(ft010_irqchip_handle_irq);
return 0; return 0;
} }
IRQCHIP_DECLARE(faraday, "faraday,ftintc010",
ft010_of_init_irq);
IRQCHIP_DECLARE(gemini, "cortina,gemini-interrupt-controller", IRQCHIP_DECLARE(gemini, "cortina,gemini-interrupt-controller",
gemini_of_init_irq); ft010_of_init_irq);
IRQCHIP_DECLARE(moxa, "moxa,moxart-ic",
ft010_of_init_irq);
...@@ -15,6 +15,7 @@ ...@@ -15,6 +15,7 @@
* along with this program. If not, see <http://www.gnu.org/licenses/>. * along with this program. If not, see <http://www.gnu.org/licenses/>.
*/ */
#include <linux/acpi_iort.h>
#include <linux/device.h> #include <linux/device.h>
#include <linux/msi.h> #include <linux/msi.h>
#include <linux/of.h> #include <linux/of.h>
...@@ -24,15 +25,11 @@ static struct irq_chip its_pmsi_irq_chip = { ...@@ -24,15 +25,11 @@ static struct irq_chip its_pmsi_irq_chip = {
.name = "ITS-pMSI", .name = "ITS-pMSI",
}; };
static int its_pmsi_prepare(struct irq_domain *domain, struct device *dev, static int of_pmsi_get_dev_id(struct irq_domain *domain, struct device *dev,
int nvec, msi_alloc_info_t *info) u32 *dev_id)
{ {
struct msi_domain_info *msi_info;
u32 dev_id;
int ret, index = 0; int ret, index = 0;
msi_info = msi_get_domain_info(domain->parent);
/* Suck the DeviceID out of the msi-parent property */ /* Suck the DeviceID out of the msi-parent property */
do { do {
struct of_phandle_args args; struct of_phandle_args args;
...@@ -43,11 +40,32 @@ static int its_pmsi_prepare(struct irq_domain *domain, struct device *dev, ...@@ -43,11 +40,32 @@ static int its_pmsi_prepare(struct irq_domain *domain, struct device *dev,
if (args.np == irq_domain_get_of_node(domain)) { if (args.np == irq_domain_get_of_node(domain)) {
if (WARN_ON(args.args_count != 1)) if (WARN_ON(args.args_count != 1))
return -EINVAL; return -EINVAL;
dev_id = args.args[0]; *dev_id = args.args[0];
break; break;
} }
} while (!ret); } while (!ret);
return ret;
}
int __weak iort_pmsi_get_dev_id(struct device *dev, u32 *dev_id)
{
return -1;
}
static int its_pmsi_prepare(struct irq_domain *domain, struct device *dev,
int nvec, msi_alloc_info_t *info)
{
struct msi_domain_info *msi_info;
u32 dev_id;
int ret;
msi_info = msi_get_domain_info(domain->parent);
if (dev->of_node)
ret = of_pmsi_get_dev_id(domain, dev, &dev_id);
else
ret = iort_pmsi_get_dev_id(dev, &dev_id);
if (ret) if (ret)
return ret; return ret;
...@@ -73,34 +91,79 @@ static struct of_device_id its_device_id[] = { ...@@ -73,34 +91,79 @@ static struct of_device_id its_device_id[] = {
{}, {},
}; };
static int __init its_pmsi_init(void) static int __init its_pmsi_init_one(struct fwnode_handle *fwnode,
const char *name)
{ {
struct device_node *np;
struct irq_domain *parent; struct irq_domain *parent;
parent = irq_find_matching_fwnode(fwnode, DOMAIN_BUS_NEXUS);
if (!parent || !msi_get_domain_info(parent)) {
pr_err("%s: unable to locate ITS domain\n", name);
return -ENXIO;
}
if (!platform_msi_create_irq_domain(fwnode, &its_pmsi_domain_info,
parent)) {
pr_err("%s: unable to create platform domain\n", name);
return -ENXIO;
}
pr_info("Platform MSI: %s domain created\n", name);
return 0;
}
#ifdef CONFIG_ACPI
static int __init
its_pmsi_parse_madt(struct acpi_subtable_header *header,
const unsigned long end)
{
struct acpi_madt_generic_translator *its_entry;
struct fwnode_handle *domain_handle;
const char *node_name;
int err = -ENXIO;
its_entry = (struct acpi_madt_generic_translator *)header;
node_name = kasprintf(GFP_KERNEL, "ITS@0x%lx",
(long)its_entry->base_address);
domain_handle = iort_find_domain_token(its_entry->translation_id);
if (!domain_handle) {
pr_err("%s: Unable to locate ITS domain handle\n", node_name);
goto out;
}
err = its_pmsi_init_one(domain_handle, node_name);
out:
kfree(node_name);
return err;
}
static void __init its_pmsi_acpi_init(void)
{
acpi_table_parse_madt(ACPI_MADT_TYPE_GENERIC_TRANSLATOR,
its_pmsi_parse_madt, 0);
}
#else
static inline void its_pmsi_acpi_init(void) { }
#endif
static void __init its_pmsi_of_init(void)
{
struct device_node *np;
for (np = of_find_matching_node(NULL, its_device_id); np; for (np = of_find_matching_node(NULL, its_device_id); np;
np = of_find_matching_node(np, its_device_id)) { np = of_find_matching_node(np, its_device_id)) {
if (!of_property_read_bool(np, "msi-controller")) if (!of_property_read_bool(np, "msi-controller"))
continue; continue;
parent = irq_find_matching_host(np, DOMAIN_BUS_NEXUS); its_pmsi_init_one(of_node_to_fwnode(np), np->full_name);
if (!parent || !msi_get_domain_info(parent)) {
pr_err("%s: unable to locate ITS domain\n",
np->full_name);
continue;
}
if (!platform_msi_create_irq_domain(of_node_to_fwnode(np),
&its_pmsi_domain_info,
parent)) {
pr_err("%s: unable to create platform domain\n",
np->full_name);
continue;
}
pr_info("Platform MSI: %s domain created\n", np->full_name);
} }
}
static int __init its_pmsi_init(void)
{
its_pmsi_of_init();
its_pmsi_acpi_init();
return 0; return 0;
} }
early_initcall(its_pmsi_init); early_initcall(its_pmsi_init);
...@@ -16,13 +16,13 @@ ...@@ -16,13 +16,13 @@
*/ */
#include <linux/acpi.h> #include <linux/acpi.h>
#include <linux/acpi_iort.h>
#include <linux/bitmap.h> #include <linux/bitmap.h>
#include <linux/cpu.h> #include <linux/cpu.h>
#include <linux/delay.h> #include <linux/delay.h>
#include <linux/dma-iommu.h> #include <linux/dma-iommu.h>
#include <linux/interrupt.h> #include <linux/interrupt.h>
#include <linux/irqdomain.h> #include <linux/irqdomain.h>
#include <linux/acpi_iort.h>
#include <linux/log2.h> #include <linux/log2.h>
#include <linux/mm.h> #include <linux/mm.h>
#include <linux/msi.h> #include <linux/msi.h>
......
...@@ -268,6 +268,11 @@ static int __init imx_gpcv2_irqchip_init(struct device_node *node, ...@@ -268,6 +268,11 @@ static int __init imx_gpcv2_irqchip_init(struct device_node *node,
imx_gpcv2_instance = cd; imx_gpcv2_instance = cd;
register_syscore_ops(&imx_gpcv2_syscore_ops); register_syscore_ops(&imx_gpcv2_syscore_ops);
/*
* Clear the OF_POPULATED flag set in of_irq_init so that
* later the GPC power domain driver will not be skipped.
*/
of_node_clear_flag(node, OF_POPULATED);
return 0; return 0;
} }
......
...@@ -16,6 +16,7 @@ ...@@ -16,6 +16,7 @@
* along with this program. If not, see <http://www.gnu.org/licenses/>. * along with this program. If not, see <http://www.gnu.org/licenses/>.
*/ */
#include <linux/acpi.h>
#include <linux/interrupt.h> #include <linux/interrupt.h>
#include <linux/irqchip.h> #include <linux/irqchip.h>
#include <linux/module.h> #include <linux/module.h>
...@@ -180,7 +181,7 @@ static int mbigen_domain_translate(struct irq_domain *d, ...@@ -180,7 +181,7 @@ static int mbigen_domain_translate(struct irq_domain *d,
unsigned long *hwirq, unsigned long *hwirq,
unsigned int *type) unsigned int *type)
{ {
if (is_of_node(fwspec->fwnode)) { if (is_of_node(fwspec->fwnode) || is_acpi_device_node(fwspec->fwnode)) {
if (fwspec->param_count != 2) if (fwspec->param_count != 2)
return -EINVAL; return -EINVAL;
...@@ -236,27 +237,15 @@ static struct irq_domain_ops mbigen_domain_ops = { ...@@ -236,27 +237,15 @@ static struct irq_domain_ops mbigen_domain_ops = {
.free = irq_domain_free_irqs_common, .free = irq_domain_free_irqs_common,
}; };
static int mbigen_device_probe(struct platform_device *pdev) static int mbigen_of_create_domain(struct platform_device *pdev,
struct mbigen_device *mgn_chip)
{ {
struct mbigen_device *mgn_chip; struct device *parent;
struct platform_device *child; struct platform_device *child;
struct irq_domain *domain; struct irq_domain *domain;
struct device_node *np; struct device_node *np;
struct device *parent;
struct resource *res;
u32 num_pins; u32 num_pins;
mgn_chip = devm_kzalloc(&pdev->dev, sizeof(*mgn_chip), GFP_KERNEL);
if (!mgn_chip)
return -ENOMEM;
mgn_chip->pdev = pdev;
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
mgn_chip->base = devm_ioremap_resource(&pdev->dev, res);
if (IS_ERR(mgn_chip->base))
return PTR_ERR(mgn_chip->base);
for_each_child_of_node(pdev->dev.of_node, np) { for_each_child_of_node(pdev->dev.of_node, np) {
if (!of_property_read_bool(np, "interrupt-controller")) if (!of_property_read_bool(np, "interrupt-controller"))
continue; continue;
...@@ -280,6 +269,91 @@ static int mbigen_device_probe(struct platform_device *pdev) ...@@ -280,6 +269,91 @@ static int mbigen_device_probe(struct platform_device *pdev)
return -ENOMEM; return -ENOMEM;
} }
return 0;
}
#ifdef CONFIG_ACPI
static int mbigen_acpi_create_domain(struct platform_device *pdev,
struct mbigen_device *mgn_chip)
{
struct irq_domain *domain;
u32 num_pins = 0;
int ret;
/*
* "num-pins" is the total number of interrupt pins implemented in
* this mbigen instance, and mbigen is an interrupt controller
* connected to ITS converting wired interrupts into MSI, so we
* use "num-pins" to alloc MSI vectors which are needed by client
* devices connected to it.
*
* Here is the DSDT device node used for mbigen in firmware:
* Device(MBI0) {
* Name(_HID, "HISI0152")
* Name(_UID, Zero)
* Name(_CRS, ResourceTemplate() {
* Memory32Fixed(ReadWrite, 0xa0080000, 0x10000)
* })
*
* Name(_DSD, Package () {
* ToUUID("daffd814-6eba-4d8c-8a91-bc9bbf4aa301"),
* Package () {
* Package () {"num-pins", 378}
* }
* })
* }
*/
ret = device_property_read_u32(&pdev->dev, "num-pins", &num_pins);
if (ret || num_pins == 0)
return -EINVAL;
domain = platform_msi_create_device_domain(&pdev->dev, num_pins,
mbigen_write_msg,
&mbigen_domain_ops,
mgn_chip);
if (!domain)
return -ENOMEM;
return 0;
}
#else
static inline int mbigen_acpi_create_domain(struct platform_device *pdev,
struct mbigen_device *mgn_chip)
{
return -ENODEV;
}
#endif
static int mbigen_device_probe(struct platform_device *pdev)
{
struct mbigen_device *mgn_chip;
struct resource *res;
int err;
mgn_chip = devm_kzalloc(&pdev->dev, sizeof(*mgn_chip), GFP_KERNEL);
if (!mgn_chip)
return -ENOMEM;
mgn_chip->pdev = pdev;
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
mgn_chip->base = devm_ioremap_resource(&pdev->dev, res);
if (IS_ERR(mgn_chip->base))
return PTR_ERR(mgn_chip->base);
if (IS_ENABLED(CONFIG_OF) && pdev->dev.of_node)
err = mbigen_of_create_domain(pdev, mgn_chip);
else if (ACPI_COMPANION(&pdev->dev))
err = mbigen_acpi_create_domain(pdev, mgn_chip);
else
err = -EINVAL;
if (err) {
dev_err(&pdev->dev, "Failed to create mbi-gen@%p irqdomain",
mgn_chip->base);
return err;
}
platform_set_drvdata(pdev, mgn_chip); platform_set_drvdata(pdev, mgn_chip);
return 0; return 0;
} }
...@@ -290,11 +364,17 @@ static const struct of_device_id mbigen_of_match[] = { ...@@ -290,11 +364,17 @@ static const struct of_device_id mbigen_of_match[] = {
}; };
MODULE_DEVICE_TABLE(of, mbigen_of_match); MODULE_DEVICE_TABLE(of, mbigen_of_match);
static const struct acpi_device_id mbigen_acpi_match[] = {
{ "HISI0152", 0 },
{}
};
MODULE_DEVICE_TABLE(acpi, mbigen_acpi_match);
static struct platform_driver mbigen_platform_driver = { static struct platform_driver mbigen_platform_driver = {
.driver = { .driver = {
.name = "Hisilicon MBIGEN-V2", .name = "Hisilicon MBIGEN-V2",
.owner = THIS_MODULE,
.of_match_table = mbigen_of_match, .of_match_table = mbigen_of_match,
.acpi_match_table = ACPI_PTR(mbigen_acpi_match),
}, },
.probe = mbigen_device_probe, .probe = mbigen_device_probe,
}; };
......
...@@ -29,25 +29,12 @@ struct gic_pcpu_mask { ...@@ -29,25 +29,12 @@ struct gic_pcpu_mask {
DECLARE_BITMAP(pcpu_mask, GIC_MAX_INTRS); DECLARE_BITMAP(pcpu_mask, GIC_MAX_INTRS);
}; };
struct gic_irq_spec {
enum {
GIC_DEVICE,
GIC_IPI
} type;
union {
struct cpumask *ipimask;
unsigned int hwirq;
};
};
static unsigned long __gic_base_addr; static unsigned long __gic_base_addr;
static void __iomem *gic_base; static void __iomem *gic_base;
static struct gic_pcpu_mask pcpu_masks[NR_CPUS]; static struct gic_pcpu_mask pcpu_masks[NR_CPUS];
static DEFINE_SPINLOCK(gic_lock); static DEFINE_SPINLOCK(gic_lock);
static struct irq_domain *gic_irq_domain; static struct irq_domain *gic_irq_domain;
static struct irq_domain *gic_dev_domain;
static struct irq_domain *gic_ipi_domain; static struct irq_domain *gic_ipi_domain;
static int gic_shared_intrs; static int gic_shared_intrs;
static int gic_vpes; static int gic_vpes;
...@@ -55,6 +42,7 @@ static unsigned int gic_cpu_pin; ...@@ -55,6 +42,7 @@ static unsigned int gic_cpu_pin;
static unsigned int timer_cpu_pin; static unsigned int timer_cpu_pin;
static struct irq_chip gic_level_irq_controller, gic_edge_irq_controller; static struct irq_chip gic_level_irq_controller, gic_edge_irq_controller;
DECLARE_BITMAP(ipi_resrv, GIC_MAX_INTRS); DECLARE_BITMAP(ipi_resrv, GIC_MAX_INTRS);
DECLARE_BITMAP(ipi_available, GIC_MAX_INTRS);
static void __gic_irq_dispatch(void); static void __gic_irq_dispatch(void);
...@@ -693,132 +681,7 @@ static int gic_shared_irq_domain_map(struct irq_domain *d, unsigned int virq, ...@@ -693,132 +681,7 @@ static int gic_shared_irq_domain_map(struct irq_domain *d, unsigned int virq,
return 0; return 0;
} }
static int gic_setup_dev_chip(struct irq_domain *d, unsigned int virq, static int gic_irq_domain_xlate(struct irq_domain *d, struct device_node *ctrlr,
unsigned int hwirq)
{
struct irq_chip *chip;
int err;
if (hwirq >= GIC_SHARED_HWIRQ_BASE) {
err = irq_domain_set_hwirq_and_chip(d, virq, hwirq,
&gic_level_irq_controller,
NULL);
} else {
switch (GIC_HWIRQ_TO_LOCAL(hwirq)) {
case GIC_LOCAL_INT_TIMER:
case GIC_LOCAL_INT_PERFCTR:
case GIC_LOCAL_INT_FDC:
/*
* HACK: These are all really percpu interrupts, but
* the rest of the MIPS kernel code does not use the
* percpu IRQ API for them.
*/
chip = &gic_all_vpes_local_irq_controller;
irq_set_handler(virq, handle_percpu_irq);
break;
default:
chip = &gic_local_irq_controller;
irq_set_handler(virq, handle_percpu_devid_irq);
irq_set_percpu_devid(virq);
break;
}
err = irq_domain_set_hwirq_and_chip(d, virq, hwirq,
chip, NULL);
}
return err;
}
static int gic_irq_domain_alloc(struct irq_domain *d, unsigned int virq,
unsigned int nr_irqs, void *arg)
{
struct gic_irq_spec *spec = arg;
irq_hw_number_t hwirq, base_hwirq;
int cpu, ret, i;
if (spec->type == GIC_DEVICE) {
/* verify that shared irqs don't conflict with an IPI irq */
if ((spec->hwirq >= GIC_SHARED_HWIRQ_BASE) &&
test_bit(GIC_HWIRQ_TO_SHARED(spec->hwirq), ipi_resrv))
return -EBUSY;
return gic_setup_dev_chip(d, virq, spec->hwirq);
} else {
base_hwirq = find_first_bit(ipi_resrv, gic_shared_intrs);
if (base_hwirq == gic_shared_intrs) {
return -ENOMEM;
}
/* check that we have enough space */
for (i = base_hwirq; i < nr_irqs; i++) {
if (!test_bit(i, ipi_resrv))
return -EBUSY;
}
bitmap_clear(ipi_resrv, base_hwirq, nr_irqs);
/* map the hwirq for each cpu consecutively */
i = 0;
for_each_cpu(cpu, spec->ipimask) {
hwirq = GIC_SHARED_TO_HWIRQ(base_hwirq + i);
ret = irq_domain_set_hwirq_and_chip(d, virq + i, hwirq,
&gic_level_irq_controller,
NULL);
if (ret)
goto error;
irq_set_handler(virq + i, handle_level_irq);
ret = gic_shared_irq_domain_map(d, virq + i, hwirq, cpu);
if (ret)
goto error;
i++;
}
/*
* tell the parent about the base hwirq we allocated so it can
* set its own domain data
*/
spec->hwirq = base_hwirq;
}
return 0;
error:
bitmap_set(ipi_resrv, base_hwirq, nr_irqs);
return ret;
}
void gic_irq_domain_free(struct irq_domain *d, unsigned int virq,
unsigned int nr_irqs)
{
irq_hw_number_t base_hwirq;
struct irq_data *data;
data = irq_get_irq_data(virq);
if (!data)
return;
base_hwirq = GIC_HWIRQ_TO_SHARED(irqd_to_hwirq(data));
bitmap_set(ipi_resrv, base_hwirq, nr_irqs);
}
int gic_irq_domain_match(struct irq_domain *d, struct device_node *node,
enum irq_domain_bus_token bus_token)
{
/* this domain should'nt be accessed directly */
return 0;
}
static const struct irq_domain_ops gic_irq_domain_ops = {
.alloc = gic_irq_domain_alloc,
.free = gic_irq_domain_free,
.match = gic_irq_domain_match,
};
static int gic_dev_domain_xlate(struct irq_domain *d, struct device_node *ctrlr,
const u32 *intspec, unsigned int intsize, const u32 *intspec, unsigned int intsize,
irq_hw_number_t *out_hwirq, irq_hw_number_t *out_hwirq,
unsigned int *out_type) unsigned int *out_type)
...@@ -837,58 +700,82 @@ static int gic_dev_domain_xlate(struct irq_domain *d, struct device_node *ctrlr, ...@@ -837,58 +700,82 @@ static int gic_dev_domain_xlate(struct irq_domain *d, struct device_node *ctrlr,
return 0; return 0;
} }
static int gic_dev_domain_alloc(struct irq_domain *d, unsigned int virq, static int gic_irq_domain_map(struct irq_domain *d, unsigned int virq,
unsigned int nr_irqs, void *arg) irq_hw_number_t hwirq)
{ {
struct irq_fwspec *fwspec = arg; int err;
struct gic_irq_spec spec = {
.type = GIC_DEVICE,
};
int i, ret;
if (fwspec->param[0] == GIC_SHARED) if (hwirq >= GIC_SHARED_HWIRQ_BASE) {
spec.hwirq = GIC_SHARED_TO_HWIRQ(fwspec->param[1]); /* verify that shared irqs don't conflict with an IPI irq */
else if (test_bit(GIC_HWIRQ_TO_SHARED(hwirq), ipi_resrv))
spec.hwirq = GIC_LOCAL_TO_HWIRQ(fwspec->param[1]); return -EBUSY;
ret = irq_domain_alloc_irqs_parent(d, virq, nr_irqs, &spec); err = irq_domain_set_hwirq_and_chip(d, virq, hwirq,
if (ret) &gic_level_irq_controller,
return ret; NULL);
if (err)
return err;
for (i = 0; i < nr_irqs; i++) { return gic_shared_irq_domain_map(d, virq, hwirq, 0);
ret = gic_setup_dev_chip(d, virq + i, spec.hwirq + i);
if (ret)
goto error;
} }
return 0; switch (GIC_HWIRQ_TO_LOCAL(hwirq)) {
case GIC_LOCAL_INT_TIMER:
case GIC_LOCAL_INT_PERFCTR:
case GIC_LOCAL_INT_FDC:
/*
* HACK: These are all really percpu interrupts, but
* the rest of the MIPS kernel code does not use the
* percpu IRQ API for them.
*/
err = irq_domain_set_hwirq_and_chip(d, virq, hwirq,
&gic_all_vpes_local_irq_controller,
NULL);
if (err)
return err;
error: irq_set_handler(virq, handle_percpu_irq);
irq_domain_free_irqs_parent(d, virq, nr_irqs); break;
return ret;
default:
err = irq_domain_set_hwirq_and_chip(d, virq, hwirq,
&gic_local_irq_controller,
NULL);
if (err)
return err;
irq_set_handler(virq, handle_percpu_devid_irq);
irq_set_percpu_devid(virq);
break;
}
return gic_local_irq_domain_map(d, virq, hwirq);
} }
void gic_dev_domain_free(struct irq_domain *d, unsigned int virq, static int gic_irq_domain_alloc(struct irq_domain *d, unsigned int virq,
unsigned int nr_irqs) unsigned int nr_irqs, void *arg)
{ {
/* no real allocation is done for dev irqs, so no need to free anything */ struct irq_fwspec *fwspec = arg;
return; irq_hw_number_t hwirq;
if (fwspec->param[0] == GIC_SHARED)
hwirq = GIC_SHARED_TO_HWIRQ(fwspec->param[1]);
else
hwirq = GIC_LOCAL_TO_HWIRQ(fwspec->param[1]);
return gic_irq_domain_map(d, virq, hwirq);
} }
static void gic_dev_domain_activate(struct irq_domain *domain, void gic_irq_domain_free(struct irq_domain *d, unsigned int virq,
struct irq_data *d) unsigned int nr_irqs)
{ {
if (GIC_HWIRQ_TO_LOCAL(d->hwirq) < GIC_NUM_LOCAL_INTRS)
gic_local_irq_domain_map(domain, d->irq, d->hwirq);
else
gic_shared_irq_domain_map(domain, d->irq, d->hwirq, 0);
} }
static struct irq_domain_ops gic_dev_domain_ops = { static const struct irq_domain_ops gic_irq_domain_ops = {
.xlate = gic_dev_domain_xlate, .xlate = gic_irq_domain_xlate,
.alloc = gic_dev_domain_alloc, .alloc = gic_irq_domain_alloc,
.free = gic_dev_domain_free, .free = gic_irq_domain_free,
.activate = gic_dev_domain_activate, .map = gic_irq_domain_map,
}; };
static int gic_ipi_domain_xlate(struct irq_domain *d, struct device_node *ctrlr, static int gic_ipi_domain_xlate(struct irq_domain *d, struct device_node *ctrlr,
...@@ -910,20 +797,32 @@ static int gic_ipi_domain_alloc(struct irq_domain *d, unsigned int virq, ...@@ -910,20 +797,32 @@ static int gic_ipi_domain_alloc(struct irq_domain *d, unsigned int virq,
unsigned int nr_irqs, void *arg) unsigned int nr_irqs, void *arg)
{ {
struct cpumask *ipimask = arg; struct cpumask *ipimask = arg;
struct gic_irq_spec spec = { irq_hw_number_t hwirq, base_hwirq;
.type = GIC_IPI, int cpu, ret, i;
.ipimask = ipimask
}; base_hwirq = find_first_bit(ipi_available, gic_shared_intrs);
int ret, i; if (base_hwirq == gic_shared_intrs)
return -ENOMEM;
ret = irq_domain_alloc_irqs_parent(d, virq, nr_irqs, &spec);
if (ret) /* check that we have enough space */
return ret; for (i = base_hwirq; i < nr_irqs; i++) {
if (!test_bit(i, ipi_available))
/* the parent should have set spec.hwirq to the base_hwirq it allocated */ return -EBUSY;
for (i = 0; i < nr_irqs; i++) { }
ret = irq_domain_set_hwirq_and_chip(d, virq + i, bitmap_clear(ipi_available, base_hwirq, nr_irqs);
GIC_SHARED_TO_HWIRQ(spec.hwirq + i),
/* map the hwirq for each cpu consecutively */
i = 0;
for_each_cpu(cpu, ipimask) {
hwirq = GIC_SHARED_TO_HWIRQ(base_hwirq + i);
ret = irq_domain_set_hwirq_and_chip(d, virq + i, hwirq,
&gic_edge_irq_controller,
NULL);
if (ret)
goto error;
ret = irq_domain_set_hwirq_and_chip(d->parent, virq + i, hwirq,
&gic_edge_irq_controller, &gic_edge_irq_controller,
NULL); NULL);
if (ret) if (ret)
...@@ -932,18 +831,32 @@ static int gic_ipi_domain_alloc(struct irq_domain *d, unsigned int virq, ...@@ -932,18 +831,32 @@ static int gic_ipi_domain_alloc(struct irq_domain *d, unsigned int virq,
ret = irq_set_irq_type(virq + i, IRQ_TYPE_EDGE_RISING); ret = irq_set_irq_type(virq + i, IRQ_TYPE_EDGE_RISING);
if (ret) if (ret)
goto error; goto error;
ret = gic_shared_irq_domain_map(d, virq + i, hwirq, cpu);
if (ret)
goto error;
i++;
} }
return 0; return 0;
error: error:
irq_domain_free_irqs_parent(d, virq, nr_irqs); bitmap_set(ipi_available, base_hwirq, nr_irqs);
return ret; return ret;
} }
void gic_ipi_domain_free(struct irq_domain *d, unsigned int virq, void gic_ipi_domain_free(struct irq_domain *d, unsigned int virq,
unsigned int nr_irqs) unsigned int nr_irqs)
{ {
irq_domain_free_irqs_parent(d, virq, nr_irqs); irq_hw_number_t base_hwirq;
struct irq_data *data;
data = irq_get_irq_data(virq);
if (!data)
return;
base_hwirq = GIC_HWIRQ_TO_SHARED(irqd_to_hwirq(data));
bitmap_set(ipi_available, base_hwirq, nr_irqs);
} }
int gic_ipi_domain_match(struct irq_domain *d, struct device_node *node, int gic_ipi_domain_match(struct irq_domain *d, struct device_node *node,
...@@ -968,38 +881,6 @@ static struct irq_domain_ops gic_ipi_domain_ops = { ...@@ -968,38 +881,6 @@ static struct irq_domain_ops gic_ipi_domain_ops = {
.match = gic_ipi_domain_match, .match = gic_ipi_domain_match,
}; };
static void __init gic_map_single_int(struct device_node *node,
unsigned int irq)
{
unsigned int linux_irq;
struct irq_fwspec local_int_fwspec = {
.fwnode = &node->fwnode,
.param_count = 3,
.param = {
[0] = GIC_LOCAL,
[1] = irq,
[2] = IRQ_TYPE_NONE,
},
};
if (!gic_local_irq_is_routable(irq))
return;
linux_irq = irq_create_fwspec_mapping(&local_int_fwspec);
WARN_ON(!linux_irq);
}
static void __init gic_map_interrupts(struct device_node *node)
{
gic_map_single_int(node, GIC_LOCAL_INT_WD);
gic_map_single_int(node, GIC_LOCAL_INT_COMPARE);
gic_map_single_int(node, GIC_LOCAL_INT_TIMER);
gic_map_single_int(node, GIC_LOCAL_INT_PERFCTR);
gic_map_single_int(node, GIC_LOCAL_INT_SWINT0);
gic_map_single_int(node, GIC_LOCAL_INT_SWINT1);
gic_map_single_int(node, GIC_LOCAL_INT_FDC);
}
static void __init __gic_init(unsigned long gic_base_addr, static void __init __gic_init(unsigned long gic_base_addr,
unsigned long gic_addrspace_size, unsigned long gic_addrspace_size,
unsigned int cpu_vec, unsigned int irqbase, unsigned int cpu_vec, unsigned int irqbase,
...@@ -1071,13 +952,6 @@ static void __init __gic_init(unsigned long gic_base_addr, ...@@ -1071,13 +952,6 @@ static void __init __gic_init(unsigned long gic_base_addr,
panic("Failed to add GIC IRQ domain"); panic("Failed to add GIC IRQ domain");
gic_irq_domain->name = "mips-gic-irq"; gic_irq_domain->name = "mips-gic-irq";
gic_dev_domain = irq_domain_add_hierarchy(gic_irq_domain, 0,
GIC_NUM_LOCAL_INTRS + gic_shared_intrs,
node, &gic_dev_domain_ops, NULL);
if (!gic_dev_domain)
panic("Failed to add GIC DEV domain");
gic_dev_domain->name = "mips-gic-dev";
gic_ipi_domain = irq_domain_add_hierarchy(gic_irq_domain, gic_ipi_domain = irq_domain_add_hierarchy(gic_irq_domain,
IRQ_DOMAIN_FLAG_IPI_PER_CPU, IRQ_DOMAIN_FLAG_IPI_PER_CPU,
GIC_NUM_LOCAL_INTRS + gic_shared_intrs, GIC_NUM_LOCAL_INTRS + gic_shared_intrs,
...@@ -1098,8 +972,8 @@ static void __init __gic_init(unsigned long gic_base_addr, ...@@ -1098,8 +972,8 @@ static void __init __gic_init(unsigned long gic_base_addr,
2 * gic_vpes); 2 * gic_vpes);
} }
bitmap_copy(ipi_available, ipi_resrv, GIC_MAX_INTRS);
gic_basic_init(); gic_basic_init();
gic_map_interrupts(node);
} }
void __init gic_init(unsigned long gic_base_addr, void __init gic_init(unsigned long gic_base_addr,
......
/*
* MOXA ART SoCs IRQ chip driver.
*
* Copyright (C) 2013 Jonas Jensen
*
* Jonas Jensen <jonas.jensen@gmail.com>
*
* This file is licensed under the terms of the GNU General Public
* License version 2. This program is licensed "as is" without any
* warranty of any kind, whether express or implied.
*/
#include <linux/io.h>
#include <linux/irq.h>
#include <linux/irqchip.h>
#include <linux/of.h>
#include <linux/of_address.h>
#include <linux/of_irq.h>
#include <linux/irqdomain.h>
#include <asm/exception.h>
#define IRQ_SOURCE_REG 0
#define IRQ_MASK_REG 0x04
#define IRQ_CLEAR_REG 0x08
#define IRQ_MODE_REG 0x0c
#define IRQ_LEVEL_REG 0x10
#define IRQ_STATUS_REG 0x14
#define FIQ_SOURCE_REG 0x20
#define FIQ_MASK_REG 0x24
#define FIQ_CLEAR_REG 0x28
#define FIQ_MODE_REG 0x2c
#define FIQ_LEVEL_REG 0x30
#define FIQ_STATUS_REG 0x34
struct moxart_irq_data {
void __iomem *base;
struct irq_domain *domain;
unsigned int interrupt_mask;
};
static struct moxart_irq_data intc;
static void __exception_irq_entry handle_irq(struct pt_regs *regs)
{
u32 irqstat;
int hwirq;
irqstat = readl(intc.base + IRQ_STATUS_REG);
while (irqstat) {
hwirq = ffs(irqstat) - 1;
handle_IRQ(irq_linear_revmap(intc.domain, hwirq), regs);
irqstat &= ~(1 << hwirq);
}
}
static int __init moxart_of_intc_init(struct device_node *node,
struct device_node *parent)
{
unsigned int clr = IRQ_NOREQUEST | IRQ_NOPROBE | IRQ_NOAUTOEN;
int ret;
struct irq_chip_generic *gc;
intc.base = of_iomap(node, 0);
if (!intc.base) {
pr_err("%s: unable to map IC registers\n",
node->full_name);
return -EINVAL;
}
intc.domain = irq_domain_add_linear(node, 32, &irq_generic_chip_ops,
intc.base);
if (!intc.domain) {
pr_err("%s: unable to create IRQ domain\n", node->full_name);
return -EINVAL;
}
ret = irq_alloc_domain_generic_chips(intc.domain, 32, 1,
"MOXARTINTC", handle_edge_irq,
clr, 0, IRQ_GC_INIT_MASK_CACHE);
if (ret) {
pr_err("%s: could not allocate generic chip\n",
node->full_name);
irq_domain_remove(intc.domain);
return -EINVAL;
}
ret = of_property_read_u32(node, "interrupt-mask",
&intc.interrupt_mask);
if (ret)
pr_err("%s: could not read interrupt-mask DT property\n",
node->full_name);
gc = irq_get_domain_generic_chip(intc.domain, 0);
gc->reg_base = intc.base;
gc->chip_types[0].regs.mask = IRQ_MASK_REG;
gc->chip_types[0].regs.ack = IRQ_CLEAR_REG;
gc->chip_types[0].chip.irq_ack = irq_gc_ack_set_bit;
gc->chip_types[0].chip.irq_mask = irq_gc_mask_clr_bit;
gc->chip_types[0].chip.irq_unmask = irq_gc_mask_set_bit;
writel(0, intc.base + IRQ_MASK_REG);
writel(0xffffffff, intc.base + IRQ_CLEAR_REG);
writel(intc.interrupt_mask, intc.base + IRQ_MODE_REG);
writel(intc.interrupt_mask, intc.base + IRQ_LEVEL_REG);
set_handle_irq(handle_irq);
return 0;
}
IRQCHIP_DECLARE(moxa_moxart_ic, "moxa,moxart-ic", moxart_of_intc_init);
/*
* Copyright (c) 2016 MediaTek Inc.
* Author: Youlin.Pei <youlin.pei@mediatek.com>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*/
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/irq.h>
#include <linux/irqchip.h>
#include <linux/irqdomain.h>
#include <linux/of.h>
#include <linux/of_irq.h>
#include <linux/of_address.h>
#include <linux/slab.h>
#include <linux/syscore_ops.h>
#define CIRQ_ACK 0x40
#define CIRQ_MASK_SET 0xc0
#define CIRQ_MASK_CLR 0x100
#define CIRQ_SENS_SET 0x180
#define CIRQ_SENS_CLR 0x1c0
#define CIRQ_POL_SET 0x240
#define CIRQ_POL_CLR 0x280
#define CIRQ_CONTROL 0x300
#define CIRQ_EN 0x1
#define CIRQ_EDGE 0x2
#define CIRQ_FLUSH 0x4
struct mtk_cirq_chip_data {
void __iomem *base;
unsigned int ext_irq_start;
unsigned int ext_irq_end;
struct irq_domain *domain;
};
static struct mtk_cirq_chip_data *cirq_data;
static void mtk_cirq_write_mask(struct irq_data *data, unsigned int offset)
{
struct mtk_cirq_chip_data *chip_data = data->chip_data;
unsigned int cirq_num = data->hwirq;
u32 mask = 1 << (cirq_num % 32);
writel_relaxed(mask, chip_data->base + offset + (cirq_num / 32) * 4);
}
static void mtk_cirq_mask(struct irq_data *data)
{
mtk_cirq_write_mask(data, CIRQ_MASK_SET);
irq_chip_mask_parent(data);
}
static void mtk_cirq_unmask(struct irq_data *data)
{
mtk_cirq_write_mask(data, CIRQ_MASK_CLR);
irq_chip_unmask_parent(data);
}
static int mtk_cirq_set_type(struct irq_data *data, unsigned int type)
{
int ret;
switch (type & IRQ_TYPE_SENSE_MASK) {
case IRQ_TYPE_EDGE_FALLING:
mtk_cirq_write_mask(data, CIRQ_POL_CLR);
mtk_cirq_write_mask(data, CIRQ_SENS_CLR);
break;
case IRQ_TYPE_EDGE_RISING:
mtk_cirq_write_mask(data, CIRQ_POL_SET);
mtk_cirq_write_mask(data, CIRQ_SENS_CLR);
break;
case IRQ_TYPE_LEVEL_LOW:
mtk_cirq_write_mask(data, CIRQ_POL_CLR);
mtk_cirq_write_mask(data, CIRQ_SENS_SET);
break;
case IRQ_TYPE_LEVEL_HIGH:
mtk_cirq_write_mask(data, CIRQ_POL_SET);
mtk_cirq_write_mask(data, CIRQ_SENS_SET);
break;
default:
break;
}
data = data->parent_data;
ret = data->chip->irq_set_type(data, type);
return ret;
}
static struct irq_chip mtk_cirq_chip = {
.name = "MT_CIRQ",
.irq_mask = mtk_cirq_mask,
.irq_unmask = mtk_cirq_unmask,
.irq_eoi = irq_chip_eoi_parent,
.irq_set_type = mtk_cirq_set_type,
.irq_retrigger = irq_chip_retrigger_hierarchy,
#ifdef CONFIG_SMP
.irq_set_affinity = irq_chip_set_affinity_parent,
#endif
};
static int mtk_cirq_domain_translate(struct irq_domain *d,
struct irq_fwspec *fwspec,
unsigned long *hwirq,
unsigned int *type)
{
if (is_of_node(fwspec->fwnode)) {
if (fwspec->param_count != 3)
return -EINVAL;
/* No PPI should point to this domain */
if (fwspec->param[0] != 0)
return -EINVAL;
/* cirq support irq number check */
if (fwspec->param[1] < cirq_data->ext_irq_start ||
fwspec->param[1] > cirq_data->ext_irq_end)
return -EINVAL;
*hwirq = fwspec->param[1] - cirq_data->ext_irq_start;
*type = fwspec->param[2] & IRQ_TYPE_SENSE_MASK;
return 0;
}
return -EINVAL;
}
static int mtk_cirq_domain_alloc(struct irq_domain *domain, unsigned int virq,
unsigned int nr_irqs, void *arg)
{
int ret;
irq_hw_number_t hwirq;
unsigned int type;
struct irq_fwspec *fwspec = arg;
struct irq_fwspec parent_fwspec = *fwspec;
ret = mtk_cirq_domain_translate(domain, fwspec, &hwirq, &type);
if (ret)
return ret;
if (WARN_ON(nr_irqs != 1))
return -EINVAL;
irq_domain_set_hwirq_and_chip(domain, virq, hwirq,
&mtk_cirq_chip,
domain->host_data);
parent_fwspec.fwnode = domain->parent->fwnode;
return irq_domain_alloc_irqs_parent(domain, virq, nr_irqs,
&parent_fwspec);
}
static const struct irq_domain_ops cirq_domain_ops = {
.translate = mtk_cirq_domain_translate,
.alloc = mtk_cirq_domain_alloc,
.free = irq_domain_free_irqs_common,
};
#ifdef CONFIG_PM_SLEEP
static int mtk_cirq_suspend(void)
{
u32 value, mask;
unsigned int irq, hwirq_num;
bool pending, masked;
int i, pendret, maskret;
/*
* When external interrupts happened, CIRQ will record the status
* even CIRQ is not enabled. When execute flush command, CIRQ will
* resend the signals according to the status. So if don't clear the
* status, CIRQ will resend the wrong signals.
*
* arch_suspend_disable_irqs() will be called before CIRQ suspend
* callback. If clear all the status simply, the external interrupts
* which happened between arch_suspend_disable_irqs and CIRQ suspend
* callback will be lost. Using following steps to avoid this issue;
*
* - Iterate over all the CIRQ supported interrupts;
* - For each interrupt, inspect its pending and masked status at GIC
* level;
* - If pending and unmasked, it happened between
* arch_suspend_disable_irqs and CIRQ suspend callback, don't ACK
* it. Otherwise, ACK it.
*/
hwirq_num = cirq_data->ext_irq_end - cirq_data->ext_irq_start + 1;
for (i = 0; i < hwirq_num; i++) {
irq = irq_find_mapping(cirq_data->domain, i);
if (irq) {
pendret = irq_get_irqchip_state(irq,
IRQCHIP_STATE_PENDING,
&pending);
maskret = irq_get_irqchip_state(irq,
IRQCHIP_STATE_MASKED,
&masked);
if (pendret == 0 && maskret == 0 &&
(pending && !masked))
continue;
}
mask = 1 << (i % 32);
writel_relaxed(mask, cirq_data->base + CIRQ_ACK + (i / 32) * 4);
}
/* set edge_only mode, record edge-triggerd interrupts */
/* enable cirq */
value = readl_relaxed(cirq_data->base + CIRQ_CONTROL);
value |= (CIRQ_EDGE | CIRQ_EN);
writel_relaxed(value, cirq_data->base + CIRQ_CONTROL);
return 0;
}
static void mtk_cirq_resume(void)
{
u32 value;
/* flush recored interrupts, will send signals to parent controller */
value = readl_relaxed(cirq_data->base + CIRQ_CONTROL);
writel_relaxed(value | CIRQ_FLUSH, cirq_data->base + CIRQ_CONTROL);
/* disable cirq */
value = readl_relaxed(cirq_data->base + CIRQ_CONTROL);
value &= ~(CIRQ_EDGE | CIRQ_EN);
writel_relaxed(value, cirq_data->base + CIRQ_CONTROL);
}
static struct syscore_ops mtk_cirq_syscore_ops = {
.suspend = mtk_cirq_suspend,
.resume = mtk_cirq_resume,
};
static void mtk_cirq_syscore_init(void)
{
register_syscore_ops(&mtk_cirq_syscore_ops);
}
#else
static inline void mtk_cirq_syscore_init(void) {}
#endif
static int __init mtk_cirq_of_init(struct device_node *node,
struct device_node *parent)
{
struct irq_domain *domain, *domain_parent;
unsigned int irq_num;
int ret;
domain_parent = irq_find_host(parent);
if (!domain_parent) {
pr_err("mtk_cirq: interrupt-parent not found\n");
return -EINVAL;
}
cirq_data = kzalloc(sizeof(*cirq_data), GFP_KERNEL);
if (!cirq_data)
return -ENOMEM;
cirq_data->base = of_iomap(node, 0);
if (!cirq_data->base) {
pr_err("mtk_cirq: unable to map cirq register\n");
ret = -ENXIO;
goto out_free;
}
ret = of_property_read_u32_index(node, "mediatek,ext-irq-range", 0,
&cirq_data->ext_irq_start);
if (ret)
goto out_unmap;
ret = of_property_read_u32_index(node, "mediatek,ext-irq-range", 1,
&cirq_data->ext_irq_end);
if (ret)
goto out_unmap;
irq_num = cirq_data->ext_irq_end - cirq_data->ext_irq_start + 1;
domain = irq_domain_add_hierarchy(domain_parent, 0,
irq_num, node,
&cirq_domain_ops, cirq_data);
if (!domain) {
ret = -ENOMEM;
goto out_unmap;
}
cirq_data->domain = domain;
mtk_cirq_syscore_init();
return 0;
out_unmap:
iounmap(cirq_data->base);
out_free:
kfree(cirq_data);
return ret;
}
IRQCHIP_DECLARE(mtk_cirq, "mediatek,mtk-cirq", mtk_cirq_of_init);
...@@ -24,22 +24,29 @@ ...@@ -24,22 +24,29 @@
struct mtk_sysirq_chip_data { struct mtk_sysirq_chip_data {
spinlock_t lock; spinlock_t lock;
void __iomem *intpol_base; u32 nr_intpol_bases;
void __iomem **intpol_bases;
u32 *intpol_words;
u8 *intpol_idx;
u16 *which_word;
}; };
static int mtk_sysirq_set_type(struct irq_data *data, unsigned int type) static int mtk_sysirq_set_type(struct irq_data *data, unsigned int type)
{ {
irq_hw_number_t hwirq = data->hwirq; irq_hw_number_t hwirq = data->hwirq;
struct mtk_sysirq_chip_data *chip_data = data->chip_data; struct mtk_sysirq_chip_data *chip_data = data->chip_data;
u8 intpol_idx = chip_data->intpol_idx[hwirq];
void __iomem *base;
u32 offset, reg_index, value; u32 offset, reg_index, value;
unsigned long flags; unsigned long flags;
int ret; int ret;
base = chip_data->intpol_bases[intpol_idx];
reg_index = chip_data->which_word[hwirq];
offset = hwirq & 0x1f; offset = hwirq & 0x1f;
reg_index = hwirq >> 5;
spin_lock_irqsave(&chip_data->lock, flags); spin_lock_irqsave(&chip_data->lock, flags);
value = readl_relaxed(chip_data->intpol_base + reg_index * 4); value = readl_relaxed(base + reg_index * 4);
if (type == IRQ_TYPE_LEVEL_LOW || type == IRQ_TYPE_EDGE_FALLING) { if (type == IRQ_TYPE_LEVEL_LOW || type == IRQ_TYPE_EDGE_FALLING) {
if (type == IRQ_TYPE_LEVEL_LOW) if (type == IRQ_TYPE_LEVEL_LOW)
type = IRQ_TYPE_LEVEL_HIGH; type = IRQ_TYPE_LEVEL_HIGH;
...@@ -49,7 +56,8 @@ static int mtk_sysirq_set_type(struct irq_data *data, unsigned int type) ...@@ -49,7 +56,8 @@ static int mtk_sysirq_set_type(struct irq_data *data, unsigned int type)
} else { } else {
value &= ~(1 << offset); value &= ~(1 << offset);
} }
writel(value, chip_data->intpol_base + reg_index * 4);
writel_relaxed(value, base + reg_index * 4);
data = data->parent_data; data = data->parent_data;
ret = data->chip->irq_set_type(data, type); ret = data->chip->irq_set_type(data, type);
...@@ -124,8 +132,7 @@ static int __init mtk_sysirq_of_init(struct device_node *node, ...@@ -124,8 +132,7 @@ static int __init mtk_sysirq_of_init(struct device_node *node,
{ {
struct irq_domain *domain, *domain_parent; struct irq_domain *domain, *domain_parent;
struct mtk_sysirq_chip_data *chip_data; struct mtk_sysirq_chip_data *chip_data;
int ret, size, intpol_num; int ret, size, intpol_num = 0, nr_intpol_bases = 0, i = 0;
struct resource res;
domain_parent = irq_find_host(parent); domain_parent = irq_find_host(parent);
if (!domain_parent) { if (!domain_parent) {
...@@ -133,36 +140,103 @@ static int __init mtk_sysirq_of_init(struct device_node *node, ...@@ -133,36 +140,103 @@ static int __init mtk_sysirq_of_init(struct device_node *node,
return -EINVAL; return -EINVAL;
} }
ret = of_address_to_resource(node, 0, &res);
if (ret)
return ret;
chip_data = kzalloc(sizeof(*chip_data), GFP_KERNEL); chip_data = kzalloc(sizeof(*chip_data), GFP_KERNEL);
if (!chip_data) if (!chip_data)
return -ENOMEM; return -ENOMEM;
size = resource_size(&res); while (of_get_address(node, i++, NULL, NULL))
intpol_num = size * 8; nr_intpol_bases++;
chip_data->intpol_base = ioremap(res.start, size);
if (!chip_data->intpol_base) { if (nr_intpol_bases == 0) {
pr_err("mtk_sysirq: unable to map sysirq register\n"); pr_err("mtk_sysirq: base address not specified\n");
ret = -ENXIO; ret = -EINVAL;
goto out_free; goto out_free_chip;
}
chip_data->intpol_words = kcalloc(nr_intpol_bases,
sizeof(*chip_data->intpol_words),
GFP_KERNEL);
if (!chip_data->intpol_words) {
ret = -ENOMEM;
goto out_free_chip;
}
chip_data->intpol_bases = kcalloc(nr_intpol_bases,
sizeof(*chip_data->intpol_bases),
GFP_KERNEL);
if (!chip_data->intpol_bases) {
ret = -ENOMEM;
goto out_free_intpol_words;
}
for (i = 0; i < nr_intpol_bases; i++) {
struct resource res;
ret = of_address_to_resource(node, i, &res);
size = resource_size(&res);
intpol_num += size * 8;
chip_data->intpol_words[i] = size / 4;
chip_data->intpol_bases[i] = of_iomap(node, i);
if (ret || !chip_data->intpol_bases[i]) {
pr_err("%s: couldn't map region %d\n",
node->full_name, i);
ret = -ENODEV;
goto out_free_intpol;
}
}
chip_data->intpol_idx = kcalloc(intpol_num,
sizeof(*chip_data->intpol_idx),
GFP_KERNEL);
if (!chip_data->intpol_idx) {
ret = -ENOMEM;
goto out_free_intpol;
}
chip_data->which_word = kcalloc(intpol_num,
sizeof(*chip_data->which_word),
GFP_KERNEL);
if (!chip_data->which_word) {
ret = -ENOMEM;
goto out_free_intpol_idx;
}
/*
* assign an index of the intpol_bases for each irq
* to set it fast later
*/
for (i = 0; i < intpol_num ; i++) {
u32 word = i / 32, j;
for (j = 0; word >= chip_data->intpol_words[j] ; j++)
word -= chip_data->intpol_words[j];
chip_data->intpol_idx[i] = j;
chip_data->which_word[i] = word;
} }
domain = irq_domain_add_hierarchy(domain_parent, 0, intpol_num, node, domain = irq_domain_add_hierarchy(domain_parent, 0, intpol_num, node,
&sysirq_domain_ops, chip_data); &sysirq_domain_ops, chip_data);
if (!domain) { if (!domain) {
ret = -ENOMEM; ret = -ENOMEM;
goto out_unmap; goto out_free_which_word;
} }
spin_lock_init(&chip_data->lock); spin_lock_init(&chip_data->lock);
return 0; return 0;
out_unmap: out_free_which_word:
iounmap(chip_data->intpol_base); kfree(chip_data->which_word);
out_free: out_free_intpol_idx:
kfree(chip_data->intpol_idx);
out_free_intpol:
for (i = 0; i < nr_intpol_bases; i++)
if (chip_data->intpol_bases[i])
iounmap(chip_data->intpol_bases[i]);
kfree(chip_data->intpol_bases);
out_free_intpol_words:
kfree(chip_data->intpol_words);
out_free_chip:
kfree(chip_data); kfree(chip_data);
return ret; return ret;
} }
......
...@@ -667,6 +667,11 @@ void alloc_bootmem_cpumask_var(cpumask_var_t *mask); ...@@ -667,6 +667,11 @@ void alloc_bootmem_cpumask_var(cpumask_var_t *mask);
void free_cpumask_var(cpumask_var_t mask); void free_cpumask_var(cpumask_var_t mask);
void free_bootmem_cpumask_var(cpumask_var_t mask); void free_bootmem_cpumask_var(cpumask_var_t mask);
static inline bool cpumask_available(cpumask_var_t mask)
{
return mask != NULL;
}
#else #else
typedef struct cpumask cpumask_var_t[1]; typedef struct cpumask cpumask_var_t[1];
...@@ -708,6 +713,11 @@ static inline void free_cpumask_var(cpumask_var_t mask) ...@@ -708,6 +713,11 @@ static inline void free_cpumask_var(cpumask_var_t mask)
static inline void free_bootmem_cpumask_var(cpumask_var_t mask) static inline void free_bootmem_cpumask_var(cpumask_var_t mask)
{ {
} }
static inline bool cpumask_available(cpumask_var_t mask)
{
return true;
}
#endif /* CONFIG_CPUMASK_OFFSTACK */ #endif /* CONFIG_CPUMASK_OFFSTACK */
/* It's common to want to use cpu_all_mask in struct member initializers, /* It's common to want to use cpu_all_mask in struct member initializers,
......
...@@ -348,7 +348,10 @@ void handle_nested_irq(unsigned int irq) ...@@ -348,7 +348,10 @@ void handle_nested_irq(unsigned int irq)
irqd_set(&desc->irq_data, IRQD_IRQ_INPROGRESS); irqd_set(&desc->irq_data, IRQD_IRQ_INPROGRESS);
raw_spin_unlock_irq(&desc->lock); raw_spin_unlock_irq(&desc->lock);
action_ret = action->thread_fn(action->irq, action->dev_id); action_ret = IRQ_NONE;
for_each_action_of_desc(desc, action)
action_ret |= action->thread_fn(action->irq, action->dev_id);
if (!noirqdebug) if (!noirqdebug)
note_interrupt(desc, action_ret); note_interrupt(desc, action_ret);
......
...@@ -852,7 +852,7 @@ irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action) ...@@ -852,7 +852,7 @@ irq_thread_check_affinity(struct irq_desc *desc, struct irqaction *action)
* This code is triggered unconditionally. Check the affinity * This code is triggered unconditionally. Check the affinity
* mask pointer. For CPU_MASK_OFFSTACK=n this is optimized out. * mask pointer. For CPU_MASK_OFFSTACK=n this is optimized out.
*/ */
if (desc->irq_common_data.affinity) if (cpumask_available(desc->irq_common_data.affinity))
cpumask_copy(mask, desc->irq_common_data.affinity); cpumask_copy(mask, desc->irq_common_data.affinity);
else else
valid = false; valid = false;
...@@ -1212,8 +1212,10 @@ __setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new) ...@@ -1212,8 +1212,10 @@ __setup_irq(unsigned int irq, struct irq_desc *desc, struct irqaction *new)
* set the trigger type must match. Also all must * set the trigger type must match. Also all must
* agree on ONESHOT. * agree on ONESHOT.
*/ */
unsigned int oldtype = irqd_get_trigger_type(&desc->irq_data);
if (!((old->flags & new->flags) & IRQF_SHARED) || if (!((old->flags & new->flags) & IRQF_SHARED) ||
((old->flags ^ new->flags) & IRQF_TRIGGER_MASK) || (oldtype != (new->flags & IRQF_TRIGGER_MASK)) ||
((old->flags ^ new->flags) & IRQF_ONESHOT)) ((old->flags ^ new->flags) & IRQF_ONESHOT))
goto mismatch; goto mismatch;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment