[POWERPC] mpc5200: add interrupt type function

Add a set_type function for external (GPIO) interrupts.

Signed-off-by: Juergen Beisert <j.beisert@pengutronix.de>
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
Signed-off-by: Grant Likely <grant.likely@secretlab.ca>

diff --git a/arch/powerpc/platforms/52xx/mpc52xx_pic.c b/arch/powerpc/platforms/52xx/mpc52xx_pic.c
index d0dead8b9a959b286cedf758b6761062a276e52f..8479394e9ab4cb884d6f329ec02cc233934c69c0 100644 (file)
--- a/arch/powerpc/platforms/52xx/mpc52xx_pic.c
+++ b/arch/powerpc/platforms/52xx/mpc52xx_pic.c
@@ -18,6 +18,7 @@
 
 #undef DEBUG
 
+#include <linux/interrupt.h>
 #include <linux/irq.h>
 #include <linux/of.h>
 #include <asm/io.h>
@@ -109,11 +110,48 @@ static void mpc52xx_extirq_ack(unsigned int virq)
        io_be_setbit(&intr->ctrl, 27-l2irq);
 }
 
+static int mpc52xx_extirq_set_type(unsigned int virq, unsigned int flow_type)
+{
+       u32 ctrl_reg, type;
+       int irq;
+       int l2irq;
+
+       irq = irq_map[virq].hwirq;
+       l2irq = (irq & MPC52xx_IRQ_L2_MASK) >> MPC52xx_IRQ_L2_OFFSET;
+
+       pr_debug("%s: irq=%x. l2=%d flow_type=%d\n", __func__, irq, l2irq, flow_type);
+
+       switch (flow_type) {
+       case IRQF_TRIGGER_HIGH:
+               type = 0;
+               break;
+       case IRQF_TRIGGER_RISING:
+               type = 1;
+               break;
+       case IRQF_TRIGGER_FALLING:
+               type = 2;
+               break;
+       case IRQF_TRIGGER_LOW:
+               type = 3;
+               break;
+       default:
+               type = 0;
+       }
+
+       ctrl_reg = in_be32(&intr->ctrl);
+       ctrl_reg &= ~(0x3 << (22 - (l2irq * 2)));
+       ctrl_reg |= (type << (22 - (l2irq * 2)));
+       out_be32(&intr->ctrl, ctrl_reg);
+
+       return 0;
+}
+
 static struct irq_chip mpc52xx_extirq_irqchip = {
        .typename = " MPC52xx IRQ[0-3] ",
        .mask = mpc52xx_extirq_mask,
        .unmask = mpc52xx_extirq_unmask,
        .ack = mpc52xx_extirq_ack,
+       .set_type = mpc52xx_extirq_set_type,
 };
 
 /*