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 ...
This commit is contained in:
commit
3cb6653552
|
@ -1,9 +1,12 @@
|
||||||
* 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:
|
||||||
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>;
|
|
@ -0,0 +1,35 @@
|
||||||
|
* 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:
|
||||||
- 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
|
||||||
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,
|
||||||
|
|
||||||
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
|
||||||
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
|
||||||
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
|
||||||
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
|
||||||
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)
|
||||||
}
|
}
|
||||||
|
|
||||||
#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)
|
||||||
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)
|
||||||
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,
|
||||||
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);
|
||||||
|
|
|
@ -0,0 +1,194 @@
|
||||||
|
/*
|
||||||
|
* irqchip for the Faraday Technology FTINTC010 Copyright (C) 2017 Linus
|
||||||
|
* Walleij <linus.walleij@linaro.org>
|
||||||
|
*
|
||||||
|
* Based on arch/arm/mach-gemini/irq.c
|
||||||
|
* Copyright (C) 2001-2006 Storlink, Corp.
|
||||||
|
* Copyright (C) 2008-2009 Paulius Zaleckas <paulius.zaleckas@gmail.com>
|
||||||
|
*/
|
||||||
|
#include <linux/bitops.h>
|
||||||
|
#include <linux/irq.h>
|
||||||
|
#include <linux/io.h>
|
||||||
|
#include <linux/irqchip.h>
|
||||||
|
#include <linux/irqchip/versatile-fpga.h>
|
||||||
|
#include <linux/irqdomain.h>
|
||||||
|
#include <linux/module.h>
|
||||||
|
#include <linux/of.h>
|
||||||
|
#include <linux/of_address.h>
|
||||||
|
#include <linux/of_irq.h>
|
||||||
|
#include <linux/cpu.h>
|
||||||
|
|
||||||
|
#include <asm/exception.h>
|
||||||
|
#include <asm/mach/irq.h>
|
||||||
|
|
||||||
|
#define FT010_NUM_IRQS 32
|
||||||
|
|
||||||
|
#define FT010_IRQ_SOURCE(base_addr) (base_addr + 0x00)
|
||||||
|
#define FT010_IRQ_MASK(base_addr) (base_addr + 0x04)
|
||||||
|
#define FT010_IRQ_CLEAR(base_addr) (base_addr + 0x08)
|
||||||
|
/* Selects level- or edge-triggered */
|
||||||
|
#define FT010_IRQ_MODE(base_addr) (base_addr + 0x0C)
|
||||||
|
/* Selects active low/high or falling/rising edge */
|
||||||
|
#define FT010_IRQ_POLARITY(base_addr) (base_addr + 0x10)
|
||||||
|
#define FT010_IRQ_STATUS(base_addr) (base_addr + 0x14)
|
||||||
|
#define FT010_FIQ_SOURCE(base_addr) (base_addr + 0x20)
|
||||||
|
#define FT010_FIQ_MASK(base_addr) (base_addr + 0x24)
|
||||||
|
#define FT010_FIQ_CLEAR(base_addr) (base_addr + 0x28)
|
||||||
|
#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 ft010_irq_data - irq data container for the Faraday IRQ controller
|
||||||
|
* @base: memory offset in virtual memory
|
||||||
|
* @chip: chip container for this instance
|
||||||
|
* @domain: IRQ domain for this instance
|
||||||
|
*/
|
||||||
|
struct ft010_irq_data {
|
||||||
|
void __iomem *base;
|
||||||
|
struct irq_chip chip;
|
||||||
|
struct irq_domain *domain;
|
||||||
|
};
|
||||||
|
|
||||||
|
static void ft010_irq_mask(struct irq_data *d)
|
||||||
|
{
|
||||||
|
struct ft010_irq_data *f = irq_data_get_irq_chip_data(d);
|
||||||
|
unsigned int mask;
|
||||||
|
|
||||||
|
mask = readl(FT010_IRQ_MASK(f->base));
|
||||||
|
mask &= ~BIT(irqd_to_hwirq(d));
|
||||||
|
writel(mask, FT010_IRQ_MASK(f->base));
|
||||||
|
}
|
||||||
|
|
||||||
|
static void ft010_irq_unmask(struct irq_data *d)
|
||||||
|
{
|
||||||
|
struct ft010_irq_data *f = irq_data_get_irq_chip_data(d);
|
||||||
|
unsigned int mask;
|
||||||
|
|
||||||
|
mask = readl(FT010_IRQ_MASK(f->base));
|
||||||
|
mask |= BIT(irqd_to_hwirq(d));
|
||||||
|
writel(mask, FT010_IRQ_MASK(f->base));
|
||||||
|
}
|
||||||
|
|
||||||
|
static void ft010_irq_ack(struct irq_data *d)
|
||||||
|
{
|
||||||
|
struct ft010_irq_data *f = irq_data_get_irq_chip_data(d);
|
||||||
|
|
||||||
|
writel(BIT(irqd_to_hwirq(d)), FT010_IRQ_CLEAR(f->base));
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ft010_irq_set_type(struct irq_data *d, unsigned int trigger)
|
||||||
|
{
|
||||||
|
struct ft010_irq_data *f = irq_data_get_irq_chip_data(d);
|
||||||
|
int offset = irqd_to_hwirq(d);
|
||||||
|
u32 mode, polarity;
|
||||||
|
|
||||||
|
mode = readl(FT010_IRQ_MODE(f->base));
|
||||||
|
polarity = readl(FT010_IRQ_POLARITY(f->base));
|
||||||
|
|
||||||
|
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);
|
||||||
|
mode &= ~BIT(offset);
|
||||||
|
polarity &= ~BIT(offset);
|
||||||
|
} else if (trigger & IRQ_TYPE_EDGE_FALLING) {
|
||||||
|
irq_set_handler_locked(d, handle_edge_irq);
|
||||||
|
mode |= BIT(offset);
|
||||||
|
polarity |= BIT(offset);
|
||||||
|
} else if (trigger & IRQ_TYPE_EDGE_RISING) {
|
||||||
|
irq_set_handler_locked(d, handle_edge_irq);
|
||||||
|
mode |= BIT(offset);
|
||||||
|
polarity &= ~BIT(offset);
|
||||||
|
} else {
|
||||||
|
irq_set_handler_locked(d, handle_bad_irq);
|
||||||
|
pr_warn("Faraday IRQ: no supported trigger selected for line %d\n",
|
||||||
|
offset);
|
||||||
|
}
|
||||||
|
|
||||||
|
writel(mode, FT010_IRQ_MODE(f->base));
|
||||||
|
writel(polarity, FT010_IRQ_POLARITY(f->base));
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct irq_chip ft010_irq_chip = {
|
||||||
|
.name = "FTINTC010",
|
||||||
|
.irq_ack = ft010_irq_ack,
|
||||||
|
.irq_mask = ft010_irq_mask,
|
||||||
|
.irq_unmask = ft010_irq_unmask,
|
||||||
|
.irq_set_type = ft010_irq_set_type,
|
||||||
|
};
|
||||||
|
|
||||||
|
/* Local static for the IRQ entry call */
|
||||||
|
static struct ft010_irq_data firq;
|
||||||
|
|
||||||
|
asmlinkage void __exception_irq_entry ft010_irqchip_handle_irq(struct pt_regs *regs)
|
||||||
|
{
|
||||||
|
struct ft010_irq_data *f = &firq;
|
||||||
|
int irq;
|
||||||
|
u32 status;
|
||||||
|
|
||||||
|
while ((status = readl(FT010_IRQ_STATUS(f->base)))) {
|
||||||
|
irq = ffs(status) - 1;
|
||||||
|
handle_domain_irq(f->domain, irq, regs);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static int ft010_irqdomain_map(struct irq_domain *d, unsigned int irq,
|
||||||
|
irq_hw_number_t hwirq)
|
||||||
|
{
|
||||||
|
struct ft010_irq_data *f = d->host_data;
|
||||||
|
|
||||||
|
irq_set_chip_data(irq, f);
|
||||||
|
/* All IRQs should set up their type, flags as bad by default */
|
||||||
|
irq_set_chip_and_handler(irq, &ft010_irq_chip, handle_bad_irq);
|
||||||
|
irq_set_probe(irq);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void ft010_irqdomain_unmap(struct irq_domain *d, unsigned int irq)
|
||||||
|
{
|
||||||
|
irq_set_chip_and_handler(irq, NULL, NULL);
|
||||||
|
irq_set_chip_data(irq, NULL);
|
||||||
|
}
|
||||||
|
|
||||||
|
static const struct irq_domain_ops ft010_irqdomain_ops = {
|
||||||
|
.map = ft010_irqdomain_map,
|
||||||
|
.unmap = ft010_irqdomain_unmap,
|
||||||
|
.xlate = irq_domain_xlate_onetwocell,
|
||||||
|
};
|
||||||
|
|
||||||
|
int __init ft010_of_init_irq(struct device_node *node,
|
||||||
|
struct device_node *parent)
|
||||||
|
{
|
||||||
|
struct ft010_irq_data *f = &firq;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Disable the idle handler by default since it is buggy
|
||||||
|
* For more info see arch/arm/mach-gemini/idle.c
|
||||||
|
*/
|
||||||
|
cpu_idle_poll_ctrl(true);
|
||||||
|
|
||||||
|
f->base = of_iomap(node, 0);
|
||||||
|
WARN(!f->base, "unable to map gemini irq registers\n");
|
||||||
|
|
||||||
|
/* Disable all interrupts */
|
||||||
|
writel(0, FT010_IRQ_MASK(f->base));
|
||||||
|
writel(0, FT010_FIQ_MASK(f->base));
|
||||||
|
|
||||||
|
f->domain = irq_domain_add_simple(node, FT010_NUM_IRQS, 0,
|
||||||
|
&ft010_irqdomain_ops, f);
|
||||||
|
set_handle_irq(ft010_irqchip_handle_irq);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
IRQCHIP_DECLARE(faraday, "faraday,ftintc010",
|
||||||
|
ft010_of_init_irq);
|
||||||
|
IRQCHIP_DECLARE(gemini, "cortina,gemini-interrupt-controller",
|
||||||
|
ft010_of_init_irq);
|
||||||
|
IRQCHIP_DECLARE(moxa, "moxa,moxart-ic",
|
||||||
|
ft010_of_init_irq);
|
|
@ -1,185 +0,0 @@
|
||||||
/*
|
|
||||||
* irqchip for the Cortina Systems Gemini Copyright (C) 2017 Linus
|
|
||||||
* Walleij <linus.walleij@linaro.org>
|
|
||||||
*
|
|
||||||
* Based on arch/arm/mach-gemini/irq.c
|
|
||||||
* Copyright (C) 2001-2006 Storlink, Corp.
|
|
||||||
* Copyright (C) 2008-2009 Paulius Zaleckas <paulius.zaleckas@teltonika.lt>
|
|
||||||
*/
|
|
||||||
#include <linux/bitops.h>
|
|
||||||
#include <linux/irq.h>
|
|
||||||
#include <linux/io.h>
|
|
||||||
#include <linux/irqchip.h>
|
|
||||||
#include <linux/irqchip/versatile-fpga.h>
|
|
||||||
#include <linux/irqdomain.h>
|
|
||||||
#include <linux/module.h>
|
|
||||||
#include <linux/of.h>
|
|
||||||
#include <linux/of_address.h>
|
|
||||||
#include <linux/of_irq.h>
|
|
||||||
#include <linux/cpu.h>
|
|
||||||
|
|
||||||
#include <asm/exception.h>
|
|
||||||
#include <asm/mach/irq.h>
|
|
||||||
|
|
||||||
#define GEMINI_NUM_IRQS 32
|
|
||||||
|
|
||||||
#define GEMINI_IRQ_SOURCE(base_addr) (base_addr + 0x00)
|
|
||||||
#define GEMINI_IRQ_MASK(base_addr) (base_addr + 0x04)
|
|
||||||
#define GEMINI_IRQ_CLEAR(base_addr) (base_addr + 0x08)
|
|
||||||
#define GEMINI_IRQ_MODE(base_addr) (base_addr + 0x0C)
|
|
||||||
#define GEMINI_IRQ_POLARITY(base_addr) (base_addr + 0x10)
|
|
||||||
#define GEMINI_IRQ_STATUS(base_addr) (base_addr + 0x14)
|
|
||||||
#define GEMINI_FIQ_SOURCE(base_addr) (base_addr + 0x20)
|
|
||||||
#define GEMINI_FIQ_MASK(base_addr) (base_addr + 0x24)
|
|
||||||
#define GEMINI_FIQ_CLEAR(base_addr) (base_addr + 0x28)
|
|
||||||
#define GEMINI_FIQ_MODE(base_addr) (base_addr + 0x2C)
|
|
||||||
#define GEMINI_FIQ_POLARITY(base_addr) (base_addr + 0x30)
|
|
||||||
#define GEMINI_FIQ_STATUS(base_addr) (base_addr + 0x34)
|
|
||||||
|
|
||||||
/**
|
|
||||||
* struct gemini_irq_data - irq data container for the Gemini IRQ controller
|
|
||||||
* @base: memory offset in virtual memory
|
|
||||||
* @chip: chip container for this instance
|
|
||||||
* @domain: IRQ domain for this instance
|
|
||||||
*/
|
|
||||||
struct gemini_irq_data {
|
|
||||||
void __iomem *base;
|
|
||||||
struct irq_chip chip;
|
|
||||||
struct irq_domain *domain;
|
|
||||||
};
|
|
||||||
|
|
||||||
static void gemini_irq_mask(struct irq_data *d)
|
|
||||||
{
|
|
||||||
struct gemini_irq_data *g = irq_data_get_irq_chip_data(d);
|
|
||||||
unsigned int mask;
|
|
||||||
|
|
||||||
mask = readl(GEMINI_IRQ_MASK(g->base));
|
|
||||||
mask &= ~BIT(irqd_to_hwirq(d));
|
|
||||||
writel(mask, GEMINI_IRQ_MASK(g->base));
|
|
||||||
}
|
|
||||||
|
|
||||||
static void gemini_irq_unmask(struct irq_data *d)
|
|
||||||
{
|
|
||||||
struct gemini_irq_data *g = irq_data_get_irq_chip_data(d);
|
|
||||||
unsigned int mask;
|
|
||||||
|
|
||||||
mask = readl(GEMINI_IRQ_MASK(g->base));
|
|
||||||
mask |= BIT(irqd_to_hwirq(d));
|
|
||||||
writel(mask, GEMINI_IRQ_MASK(g->base));
|
|
||||||
}
|
|
||||||
|
|
||||||
static void gemini_irq_ack(struct irq_data *d)
|
|
||||||
{
|
|
||||||
struct gemini_irq_data *g = irq_data_get_irq_chip_data(d);
|
|
||||||
|
|
||||||
writel(BIT(irqd_to_hwirq(d)), GEMINI_IRQ_CLEAR(g->base));
|
|
||||||
}
|
|
||||||
|
|
||||||
static int gemini_irq_set_type(struct irq_data *d, unsigned int trigger)
|
|
||||||
{
|
|
||||||
struct gemini_irq_data *g = irq_data_get_irq_chip_data(d);
|
|
||||||
int offset = irqd_to_hwirq(d);
|
|
||||||
u32 mode, polarity;
|
|
||||||
|
|
||||||
mode = readl(GEMINI_IRQ_MODE(g->base));
|
|
||||||
polarity = readl(GEMINI_IRQ_POLARITY(g->base));
|
|
||||||
|
|
||||||
if (trigger & (IRQ_TYPE_LEVEL_HIGH)) {
|
|
||||||
irq_set_handler_locked(d, handle_level_irq);
|
|
||||||
/* Disable edge detection */
|
|
||||||
mode &= ~BIT(offset);
|
|
||||||
polarity &= ~BIT(offset);
|
|
||||||
} else if (trigger & IRQ_TYPE_EDGE_RISING) {
|
|
||||||
irq_set_handler_locked(d, handle_edge_irq);
|
|
||||||
mode |= BIT(offset);
|
|
||||||
polarity |= BIT(offset);
|
|
||||||
} else if (trigger & IRQ_TYPE_EDGE_FALLING) {
|
|
||||||
irq_set_handler_locked(d, handle_edge_irq);
|
|
||||||
mode |= BIT(offset);
|
|
||||||
polarity &= ~BIT(offset);
|
|
||||||
} else {
|
|
||||||
irq_set_handler_locked(d, handle_bad_irq);
|
|
||||||
pr_warn("GEMINI IRQ: no supported trigger selected for line %d\n",
|
|
||||||
offset);
|
|
||||||
}
|
|
||||||
|
|
||||||
writel(mode, GEMINI_IRQ_MODE(g->base));
|
|
||||||
writel(polarity, GEMINI_IRQ_POLARITY(g->base));
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static struct irq_chip gemini_irq_chip = {
|
|
||||||
.name = "GEMINI",
|
|
||||||
.irq_ack = gemini_irq_ack,
|
|
||||||
.irq_mask = gemini_irq_mask,
|
|
||||||
.irq_unmask = gemini_irq_unmask,
|
|
||||||
.irq_set_type = gemini_irq_set_type,
|
|
||||||
};
|
|
||||||
|
|
||||||
/* Local static for the IRQ entry call */
|
|
||||||
static struct gemini_irq_data girq;
|
|
||||||
|
|
||||||
asmlinkage void __exception_irq_entry gemini_irqchip_handle_irq(struct pt_regs *regs)
|
|
||||||
{
|
|
||||||
struct gemini_irq_data *g = &girq;
|
|
||||||
int irq;
|
|
||||||
u32 status;
|
|
||||||
|
|
||||||
while ((status = readl(GEMINI_IRQ_STATUS(g->base)))) {
|
|
||||||
irq = ffs(status) - 1;
|
|
||||||
handle_domain_irq(g->domain, irq, regs);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
static int gemini_irqdomain_map(struct irq_domain *d, unsigned int irq,
|
|
||||||
irq_hw_number_t hwirq)
|
|
||||||
{
|
|
||||||
struct gemini_irq_data *g = d->host_data;
|
|
||||||
|
|
||||||
irq_set_chip_data(irq, g);
|
|
||||||
/* 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_probe(irq);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void gemini_irqdomain_unmap(struct irq_domain *d, unsigned int irq)
|
|
||||||
{
|
|
||||||
irq_set_chip_and_handler(irq, NULL, NULL);
|
|
||||||
irq_set_chip_data(irq, NULL);
|
|
||||||
}
|
|
||||||
|
|
||||||
static const struct irq_domain_ops gemini_irqdomain_ops = {
|
|
||||||
.map = gemini_irqdomain_map,
|
|
||||||
.unmap = gemini_irqdomain_unmap,
|
|
||||||
.xlate = irq_domain_xlate_onetwocell,
|
|
||||||
};
|
|
||||||
|
|
||||||
int __init gemini_of_init_irq(struct device_node *node,
|
|
||||||
struct device_node *parent)
|
|
||||||
{
|
|
||||||
struct gemini_irq_data *g = &girq;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Disable the idle handler by default since it is buggy
|
|
||||||
* For more info see arch/arm/mach-gemini/idle.c
|
|
||||||
*/
|
|
||||||
cpu_idle_poll_ctrl(true);
|
|
||||||
|
|
||||||
g->base = of_iomap(node, 0);
|
|
||||||
WARN(!g->base, "unable to map gemini irq registers\n");
|
|
||||||
|
|
||||||
/* Disable all interrupts */
|
|
||||||
writel(0, GEMINI_IRQ_MASK(g->base));
|
|
||||||
writel(0, GEMINI_FIQ_MASK(g->base));
|
|
||||||
|
|
||||||
g->domain = irq_domain_add_simple(node, GEMINI_NUM_IRQS, 0,
|
|
||||||
&gemini_irqdomain_ops, g);
|
|
||||||
set_handle_irq(gemini_irqchip_handle_irq);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
IRQCHIP_DECLARE(gemini, "cortina,gemini-interrupt-controller",
|
|
||||||
gemini_of_init_irq);
|
|
|
@ -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 = {
|
||||||
.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,
|
||||||
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[] = {
|
||||||
{},
|
{},
|
||||||
};
|
};
|
||||||
|
|
||||||
static int __init its_pmsi_init(void)
|
static int __init its_pmsi_init_one(struct fwnode_handle *fwnode,
|
||||||
|
const char *name)
|
||||||
|
{
|
||||||
|
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;
|
struct device_node *np;
|
||||||
struct irq_domain *parent;
|
|
||||||
|
|
||||||
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 @@
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#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,
|
||||||
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 @@
|
||||||
* 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,
|
||||||
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 = {
|
||||||
.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)
|
||||||
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[] = {
|
||||||
};
|
};
|
||||||
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 {
|
||||||
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;
|
||||||
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,
|
||||||
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,
|
||||||
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,
|
||||||
|
irq_hw_number_t hwirq)
|
||||||
|
{
|
||||||
|
int err;
|
||||||
|
|
||||||
|
if (hwirq >= GIC_SHARED_HWIRQ_BASE) {
|
||||||
|
/* verify that shared irqs don't conflict with an IPI irq */
|
||||||
|
if (test_bit(GIC_HWIRQ_TO_SHARED(hwirq), ipi_resrv))
|
||||||
|
return -EBUSY;
|
||||||
|
|
||||||
|
err = irq_domain_set_hwirq_and_chip(d, virq, hwirq,
|
||||||
|
&gic_level_irq_controller,
|
||||||
|
NULL);
|
||||||
|
if (err)
|
||||||
|
return err;
|
||||||
|
|
||||||
|
return gic_shared_irq_domain_map(d, virq, hwirq, 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;
|
||||||
|
|
||||||
|
irq_set_handler(virq, handle_percpu_irq);
|
||||||
|
break;
|
||||||
|
|
||||||
|
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);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int gic_irq_domain_alloc(struct irq_domain *d, unsigned int virq,
|
||||||
unsigned int nr_irqs, void *arg)
|
unsigned int nr_irqs, void *arg)
|
||||||
{
|
{
|
||||||
struct irq_fwspec *fwspec = arg;
|
struct irq_fwspec *fwspec = arg;
|
||||||
struct gic_irq_spec spec = {
|
irq_hw_number_t hwirq;
|
||||||
.type = GIC_DEVICE,
|
|
||||||
};
|
|
||||||
int i, ret;
|
|
||||||
|
|
||||||
if (fwspec->param[0] == GIC_SHARED)
|
if (fwspec->param[0] == GIC_SHARED)
|
||||||
spec.hwirq = GIC_SHARED_TO_HWIRQ(fwspec->param[1]);
|
hwirq = GIC_SHARED_TO_HWIRQ(fwspec->param[1]);
|
||||||
else
|
else
|
||||||
spec.hwirq = GIC_LOCAL_TO_HWIRQ(fwspec->param[1]);
|
hwirq = GIC_LOCAL_TO_HWIRQ(fwspec->param[1]);
|
||||||
|
|
||||||
ret = irq_domain_alloc_irqs_parent(d, virq, nr_irqs, &spec);
|
return gic_irq_domain_map(d, virq, hwirq);
|
||||||
if (ret)
|
|
||||||
return ret;
|
|
||||||
|
|
||||||
for (i = 0; i < nr_irqs; i++) {
|
|
||||||
ret = gic_setup_dev_chip(d, virq + i, spec.hwirq + i);
|
|
||||||
if (ret)
|
|
||||||
goto error;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
error:
|
|
||||||
irq_domain_free_irqs_parent(d, virq, nr_irqs);
|
|
||||||
return ret;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void gic_dev_domain_free(struct irq_domain *d, unsigned int virq,
|
void gic_irq_domain_free(struct irq_domain *d, unsigned int virq,
|
||||||
unsigned int nr_irqs)
|
unsigned int nr_irqs)
|
||||||
{
|
{
|
||||||
/* no real allocation is done for dev irqs, so no need to free anything */
|
|
||||||
return;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void gic_dev_domain_activate(struct irq_domain *domain,
|
static const struct irq_domain_ops gic_irq_domain_ops = {
|
||||||
struct irq_data *d)
|
.xlate = gic_irq_domain_xlate,
|
||||||
{
|
.alloc = gic_irq_domain_alloc,
|
||||||
if (GIC_HWIRQ_TO_LOCAL(d->hwirq) < GIC_NUM_LOCAL_INTRS)
|
.free = gic_irq_domain_free,
|
||||||
gic_local_irq_domain_map(domain, d->irq, d->hwirq);
|
.map = gic_irq_domain_map,
|
||||||
else
|
|
||||||
gic_shared_irq_domain_map(domain, d->irq, d->hwirq, 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
static struct irq_domain_ops gic_dev_domain_ops = {
|
|
||||||
.xlate = gic_dev_domain_xlate,
|
|
||||||
.alloc = gic_dev_domain_alloc,
|
|
||||||
.free = gic_dev_domain_free,
|
|
||||||
.activate = gic_dev_domain_activate,
|
|
||||||
};
|
};
|
||||||
|
|
||||||
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,
|
||||||
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
|
|
||||||
};
|
|
||||||
int ret, i;
|
|
||||||
|
|
||||||
ret = irq_domain_alloc_irqs_parent(d, virq, nr_irqs, &spec);
|
base_hwirq = find_first_bit(ipi_available, gic_shared_intrs);
|
||||||
if (ret)
|
if (base_hwirq == gic_shared_intrs)
|
||||||
return ret;
|
return -ENOMEM;
|
||||||
|
|
||||||
/* the parent should have set spec.hwirq to the base_hwirq it allocated */
|
/* check that we have enough space */
|
||||||
for (i = 0; i < nr_irqs; i++) {
|
for (i = base_hwirq; i < nr_irqs; i++) {
|
||||||
ret = irq_domain_set_hwirq_and_chip(d, virq + i,
|
if (!test_bit(i, ipi_available))
|
||||||
GIC_SHARED_TO_HWIRQ(spec.hwirq + i),
|
return -EBUSY;
|
||||||
|
}
|
||||||
|
bitmap_clear(ipi_available, base_hwirq, nr_irqs);
|
||||||
|
|
||||||
|
/* 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,
|
||||||
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 = {
|
||||||
.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,
|
||||||
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,
|
||||||
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,
|
||||||
|
|
|
@ -1,116 +0,0 @@
|
||||||
/*
|
|
||||||
* 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);
|
|
|
@ -0,0 +1,306 @@
|
||||||
|
/*
|
||||||
|
* 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 @@
|
||||||
|
|
||||||
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)
|
||||||
} 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,
|
||||||
{
|
{
|
||||||
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,
|
||||||
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);
|
||||||
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)
|
||||||
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)
|
||||||
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)
|
||||||
* 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)
|
||||||
* 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;
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue