On Fri, Oct 11, 2013 at 4:23 PM, Neil Zhang <zhangwm@xxxxxxxxxxx> wrote:
> 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 <zhangwm@xxxxxxxxxxx>
> ---
> .../devicetree/bindings/arm/mrvl/intc.txt | 14 ++-
> drivers/irqchip/irq-mmp.c | 124 ++++++++++++++++++++
> include/linux/irqchip/mmp.h | 13 ++
> 3 files changed, 150 insertions(+), 1 deletion(-)
>
> diff --git a/Documentation/devicetree/bindings/arm/mrvl/intc.txt b/Documentation/devicetree/bindings/arm/mrvl/intc.txt
> index 8b53273..4180928 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.
As my understanding, we should avoid to write register settings in DTS file.
Loop devicetree guys.
> +- 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..445a00c 100644
> --- a/drivers/irqchip/irq-mmp.c
> +++ b/drivers/irqchip/irq-mmp.c
> @@ -16,6 +16,8 @@
> #include <linux/init.h>
> #include <linux/irq.h>
> #include <linux/irqdomain.h>
> +#include <linux/irqchip/mmp.h>
> +#include <linux/irqchip/arm-gic.h>
> #include <linux/io.h>
> #include <linux/ioport.h>
> #include <linux/of_address.h>
> @@ -58,6 +60,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 +127,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 +539,81 @@ 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;
> +
> + 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..93b05ad 100644
> --- a/include/linux/irqchip/mmp.h
> +++ b/include/linux/irqchip/mmp.h
> @@ -1,6 +1,19 @@
> #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
>
--
To unsubscribe from this list: send the line "unsubscribe devicetree" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
