For example, arm64 doesn't have mach/irq.h.
Signed-off-by: Neil Zhang <[email protected]>
---
drivers/irqchip/irq-mmp.c | 2 +-
1 file changed, 1 insertion(+), 1 deletion(-)
diff --git a/drivers/irqchip/irq-mmp.c b/drivers/irqchip/irq-mmp.c
index 2cb7cd0..470c5de 100644
--- a/drivers/irqchip/irq-mmp.c
+++ b/drivers/irqchip/irq-mmp.c
@@ -22,7 +22,7 @@
#include <linux/of_irq.h>
#include <asm/exception.h>
-#include <asm/mach/irq.h>
+#include <asm/hardirq.h>
#include "irqchip.h"
--
1.7.9.5
Some of the Marvell SoCs use GIC as its interrupt controller, and ICU
only used as wakeup logic. When AP subsystem is powered off, GIC will
lose its context, the PMU will need ICU to wakeup the AP subsystem.
So add wakeup entry for such kind of usage.
Signed-off-by: Neil Zhang <[email protected]>
---
.../devicetree/bindings/arm/mrvl/intc.txt | 14 ++-
drivers/irqchip/irq-mmp.c | 124 ++++++++++++++++++++
include/linux/irqchip/mmp.h | 14 +++
3 files changed, 151 insertions(+), 1 deletion(-)
diff --git a/Documentation/devicetree/bindings/arm/mrvl/intc.txt b/Documentation/devicetree/bindings/arm/mrvl/intc.txt
index 8b53273..6fa01b4 100644
--- a/Documentation/devicetree/bindings/arm/mrvl/intc.txt
+++ b/Documentation/devicetree/bindings/arm/mrvl/intc.txt
@@ -2,7 +2,7 @@
Required properties:
- compatible : Should be "mrvl,mmp-intc", "mrvl,mmp2-intc" or
- "mrvl,mmp2-mux-intc"
+ "mrvl,mmp2-mux-intc", "mrvl,mmp-intc-wakeupgen"
- reg : Address and length of the register set of the interrupt controller.
If the interrupt controller is intc, address and length means the range
of the whold interrupt controller. If the interrupt controller is mux-intc,
@@ -15,6 +15,9 @@ Required properties:
- interrupt-controller : Identifies the node as an interrupt controller.
- #interrupt-cells : Specifies the number of cells needed to encode an
interrupt source.
+- mrvl,intc-gbl-mask : Specifies the address and value for global mask in the
+ interrupt controller.
+- mrvl,intc-for-cp : Specifies the irqs that will be routed to cp
- mrvl,intc-nr-irqs : Specifies the number of interrupts in the interrupt
controller.
- mrvl,clr-mfp-irq : Specifies the interrupt that needs to clear MFP edge
@@ -39,6 +42,15 @@ Example:
mrvl,intc-nr-irqs = <2>;
};
+ intc: wakeupgen@d4282000 {
+ compatible = "mrvl,mmp-intc-wakeupgen";
+ reg = <0xd4282000 0x1000>;
+ mrvl,intc-nr-irqs = <64>;
+ mrvl,intc-gbl-mask = <0x114 0x3
+ 0x144 0x3>;
+ mrvl,intc-for-cp = <0 31 32>;
+ };
+
* Marvell Orion Interrupt controller
Required properties
diff --git a/drivers/irqchip/irq-mmp.c b/drivers/irqchip/irq-mmp.c
index 470c5de..7e194b4 100644
--- a/drivers/irqchip/irq-mmp.c
+++ b/drivers/irqchip/irq-mmp.c
@@ -16,6 +16,7 @@
#include <linux/init.h>
#include <linux/irq.h>
#include <linux/irqdomain.h>
+#include <linux/irqchip/arm-gic.h>
#include <linux/io.h>
#include <linux/ioport.h>
#include <linux/of_address.h>
@@ -58,6 +59,8 @@ struct mmp_intc_conf {
static void __iomem *mmp_icu_base;
static struct icu_chip_data icu_data[MAX_ICU_NR];
static int max_icu_nr;
+static u32 irq_for_cp[64];
+static u32 irq_for_cp_nr; /* How many irqs will be routed to cp */
extern void mmp2_clear_pmic_int(void);
@@ -123,6 +126,50 @@ static void icu_unmask_irq(struct irq_data *d)
}
}
+static int irq_ignore_wakeup(struct icu_chip_data *data, int hwirq)
+{
+ int i;
+
+ if (hwirq < 0 || hwirq >= data->nr_irqs)
+ return 1;
+
+ for (i = 0; i < irq_for_cp_nr; i++)
+ if (irq_for_cp[i] == hwirq)
+ return 1;
+
+ return 0;
+}
+
+static void icu_mask_irq_wakeup(struct irq_data *d)
+{
+ struct icu_chip_data *data = &icu_data[0];
+ int hwirq = d->hwirq - data->virq_base;
+ u32 r;
+
+ if (irq_ignore_wakeup(data, hwirq))
+ return;
+
+ r = readl_relaxed(mmp_icu_base + (hwirq << 2));
+ r &= ~data->conf_mask;
+ r |= data->conf_disable;
+ writel_relaxed(r, mmp_icu_base + (hwirq << 2));
+}
+
+static void icu_unmask_irq_wakeup(struct irq_data *d)
+{
+ struct icu_chip_data *data = &icu_data[0];
+ int hwirq = d->irq - data->virq_base;
+ u32 r;
+
+ if (irq_ignore_wakeup(data, hwirq))
+ return;
+
+ r = readl_relaxed(mmp_icu_base + (hwirq << 2));
+ r &= ~data->conf_mask;
+ r |= data->conf_enable;
+ writel_relaxed(r, mmp_icu_base + (hwirq << 2));
+}
+
struct irq_chip icu_irq_chip = {
.name = "icu_irq",
.irq_mask = icu_mask_irq,
@@ -491,5 +538,82 @@ err:
irq_domain_remove(icu_data[i].domain);
return -EINVAL;
}
+
+void __init mmp_of_wakeup_init(void)
+{
+ struct device_node *node;
+ const __be32 *wakeup_reg;
+ const __be32 *cp_irq_reg;
+ int ret, nr_irqs;
+ int size, i = 0;
+ int irq;
+
+ node = of_find_compatible_node(NULL, NULL, "mrvl,mmp-intc-wakeupgen");
+ if (!node) {
+ pr_err("Failed to find interrupt controller in arch-mmp\n");
+ return;
+ }
+
+ mmp_icu_base = of_iomap(node, 0);
+ if (!mmp_icu_base) {
+ pr_err("Failed to get interrupt controller register\n");
+ return;
+ }
+
+ ret = of_property_read_u32(node, "mrvl,intc-nr-irqs", &nr_irqs);
+ if (ret) {
+ pr_err("Not found mrvl,intc-nr-irqs property\n");
+ return;
+ }
+
+ /*
+ * Config all the interrupt source be able to interrupt the cpu 0,
+ * in IRQ mode, with priority 0 as masked by default.
+ */
+ for (irq = 0; irq < nr_irqs; irq++)
+ __raw_writel(ICU_IRQ_CPU0_MASKED, mmp_icu_base + (irq << 2));
+
+ /* ICU is only used as wake up logic
+ * disable the global irq/fiq in icu for all cores.
+ */
+ wakeup_reg = of_get_property(node, "mrvl,intc-gbl-mask", &size);
+ if (!wakeup_reg) {
+ pr_err("Not found mrvl,intc-gbl-mask property\n");
+ return;
+ }
+
+ size /= sizeof(*wakeup_reg);
+ while (i < size) {
+ unsigned offset, val;
+
+ offset = be32_to_cpup(wakeup_reg + i++);
+ val = be32_to_cpup(wakeup_reg + i++);
+ writel_relaxed(val, mmp_icu_base + offset);
+ }
+
+ /* Get the irq lines and ignore irqs */
+ cp_irq_reg = of_get_property(node, "mrvl,intc-for-cp", &size);
+ if (!cp_irq_reg)
+ return;
+
+ irq_for_cp_nr = size / sizeof(*cp_irq_reg);
+ for (i = 0; i < irq_for_cp_nr; i++) {
+ irq_for_cp[i] = be32_to_cpup(cp_irq_reg + i);
+ __raw_writel(ICU_CONF_SEAGULL, mmp_icu_base + (irq_for_cp[i] << 2));
+ }
+
+ icu_data[0].conf_enable = mmp_conf.conf_enable;
+ icu_data[0].conf_disable = mmp_conf.conf_disable;
+ icu_data[0].conf_mask = mmp_conf.conf_mask;
+ icu_data[0].nr_irqs = nr_irqs;
+ icu_data[0].virq_base = 32;
+
+ gic_arch_extn.irq_mask = icu_mask_irq_wakeup;
+ gic_arch_extn.irq_unmask = icu_unmask_irq_wakeup;
+ gic_arch_extn.irq_set_affinity = icu_set_affinity;
+
+ return;
+}
+
IRQCHIP_DECLARE(mmp2_mux_intc, "mrvl,mmp2-mux-intc", mmp2_mux_of_init);
#endif
diff --git a/include/linux/irqchip/mmp.h b/include/linux/irqchip/mmp.h
index c78a892..0f22f57 100644
--- a/include/linux/irqchip/mmp.h
+++ b/include/linux/irqchip/mmp.h
@@ -1,6 +1,20 @@
#ifndef __IRQCHIP_MMP_H
#define __IRQCHIP_MMP_H
+#define ICU_CONF_CPU3 (1 << 9)
+#define ICU_CONF_CPU2 (1 << 8)
+#define ICU_CONF_CPU1 (1 << 7)
+#define ICU_CONF_CPU0 (1 << 6)
+#define ICU_CONF_AP(n) (1 << (6 + (n & 0x3)))
+#define ICU_CONF_AP_MASK (0xF << 6)
+#define ICU_CONF_SEAGULL (1 << 5)
+#define ICU_CONF_IRQ_FIQ (1 << 4)
+#define ICU_CONF_PRIO(n) (n & 0xF)
+
+#define ICU_IRQ_CPU0_MASKED (ICU_CONF_IRQ_FIQ | ICU_CONF_CPU0)
+
extern struct irq_chip icu_irq_chip;
+extern void __init mmp_of_wakeup_init(void);
+
#endif /* __IRQCHIP_MMP_H */
--
1.7.9.5