[PATCH] powerpc/5200: add GPIO functions for simple interrupt GPIOs

[Anatolij Gustschin]

The mpc52xx_gpio driver currently supports 8 wakeup GPIOs and 32
simple GPIOs. Extend it to also support GPIO function of 8 simple
interrupt GPIOs controlled in the standard GPIO register module.

Signed-off-by: Anatolij Gustschin <ag...@denx.de>
---
 arch/powerpc/platforms/52xx/mpc52xx_gpio.c |  117 ++++++++++++++++++++++++++++
 1 files changed, 117 insertions(+), 0 deletions(-)

diff --git a/arch/powerpc/platforms/52xx/mpc52xx_gpio.c 
b/arch/powerpc/platforms/52xx/mpc52xx_gpio.c
index 1757d1d..42a0759 100644
--- a/arch/powerpc/platforms/52xx/mpc52xx_gpio.c
+++ b/arch/powerpc/platforms/52xx/mpc52xx_gpio.c
@@ -35,6 +35,9 @@ struct mpc52xx_gpiochip {
        unsigned int shadow_dvo;
        unsigned int shadow_gpioe;
        unsigned int shadow_ddr;
+       unsigned char sint_shadow_dvo;
+       unsigned char sint_shadow_gpioe;
+       unsigned char sint_shadow_ddr;
 };
 
 /*
@@ -309,6 +312,100 @@ mpc52xx_simple_gpio_dir_out(struct gpio_chip *gc, 
unsigned int gpio, int val)
        return 0;
 }
 
+static int mpc52xx_sint_gpio_get(struct gpio_chip *gc, unsigned int gpio)
+{
+       struct of_mm_gpio_chip *mm_gc = to_of_mm_gpio_chip(gc);
+       struct mpc52xx_gpio __iomem *regs = mm_gc->regs;
+       unsigned int ret;
+
+       ret = (in_8(&regs->sint_ival) >> (7 - gpio)) & 1;
+
+       pr_debug("%s: gpio: %d ret: %d\n", __func__, gpio, ret);
+
+       return ret;
+}
+
+static inline void
+__mpc52xx_sint_gpio_set(struct gpio_chip *gc, unsigned int gpio, int val)
+{
+       struct of_mm_gpio_chip *mm_gc = to_of_mm_gpio_chip(gc);
+       struct mpc52xx_gpiochip *chip = container_of(mm_gc,
+                       struct mpc52xx_gpiochip, mmchip);
+       struct mpc52xx_gpio __iomem *regs = mm_gc->regs;
+
+       if (val)
+               chip->sint_shadow_dvo |= 1 << (7 - gpio);
+       else
+               chip->sint_shadow_dvo &= ~(1 << (7 - gpio));
+
+       out_8(&regs->sint_dvo, chip->sint_shadow_dvo);
+}
+
+static void
+mpc52xx_sint_gpio_set(struct gpio_chip *gc, unsigned int gpio, int val)
+{
+       unsigned long flags;
+
+       spin_lock_irqsave(&gpio_lock, flags);
+
+       __mpc52xx_sint_gpio_set(gc, gpio, val);
+
+       spin_unlock_irqrestore(&gpio_lock, flags);
+
+       pr_debug("%s: gpio: %d val: %d\n", __func__, gpio, val);
+}
+
+static int mpc52xx_sint_gpio_dir_in(struct gpio_chip *gc, unsigned int gpio)
+{
+       struct of_mm_gpio_chip *mm_gc = to_of_mm_gpio_chip(gc);
+       struct mpc52xx_gpiochip *chip = container_of(mm_gc,
+                       struct mpc52xx_gpiochip, mmchip);
+       struct mpc52xx_gpio __iomem *regs = mm_gc->regs;
+       unsigned long flags;
+
+       spin_lock_irqsave(&gpio_lock, flags);
+
+       /* set the direction */
+       chip->sint_shadow_ddr &= ~(1 << (7 - gpio));
+       out_8(&regs->sint_ddr, chip->sint_shadow_ddr);
+
+       /* and enable the pin */
+       chip->sint_shadow_gpioe |= 1 << (7 - gpio);
+       out_8(&regs->sint_gpioe, chip->sint_shadow_gpioe);
+
+       spin_unlock_irqrestore(&gpio_lock, flags);
+
+       return 0;
+}
+
+static int
+mpc52xx_sint_gpio_dir_out(struct gpio_chip *gc, unsigned int gpio, int val)
+{
+       struct of_mm_gpio_chip *mm_gc = to_of_mm_gpio_chip(gc);
+       struct mpc52xx_gpio __iomem *regs = mm_gc->regs;
+       struct mpc52xx_gpiochip *chip = container_of(mm_gc,
+                       struct mpc52xx_gpiochip, mmchip);
+       unsigned long flags;
+
+       spin_lock_irqsave(&gpio_lock, flags);
+
+       __mpc52xx_sint_gpio_set(gc, gpio, val);
+
+       /* Then set direction */
+       chip->sint_shadow_ddr |= 1 << (7 - gpio);
+       out_8(&regs->sint_ddr, chip->sint_shadow_ddr);
+
+       /* Finally enable the pin */
+       chip->sint_shadow_gpioe |= 1 << (7 - gpio);
+       out_8(&regs->sint_gpioe, chip->sint_shadow_gpioe);
+
+       spin_unlock_irqrestore(&gpio_lock, flags);
+
+       pr_debug("%s: gpio: %d val: %d\n", __func__, gpio, val);
+
+       return 0;
+}
+
 static int __devinit mpc52xx_simple_gpiochip_probe(struct platform_device 
*ofdev)
 {
        struct mpc52xx_gpiochip *chip;
@@ -337,6 +434,26 @@ static int __devinit mpc52xx_simple_gpiochip_probe(struct 
platform_device *ofdev
        chip->shadow_ddr = in_be32(&regs->simple_ddr);
        chip->shadow_dvo = in_be32(&regs->simple_dvo);
 
+       chip = kzalloc(sizeof(*chip), GFP_KERNEL);
+       if (!chip)
+               return -ENOMEM;
+
+       gc = &chip->mmchip.gc;
+
+       gc->ngpio            = 8;
+       gc->direction_input  = mpc52xx_sint_gpio_dir_in;
+       gc->direction_output = mpc52xx_sint_gpio_dir_out;
+       gc->get              = mpc52xx_sint_gpio_get;
+       gc->set              = mpc52xx_sint_gpio_set;
+
+       ret = of_mm_gpiochip_add(ofdev->dev.of_node, &chip->mmchip);
+       if (ret)
+               return ret;
+
+       regs = chip->mmchip.regs;
+       chip->sint_shadow_gpioe = in_8(&regs->sint_gpioe);
+       chip->sint_shadow_ddr = in_8(&regs->sint_ddr);
+       chip->sint_shadow_dvo = in_8(&regs->sint_dvo);
        return 0;
 }
 
-- 
1.7.1

_______________________________________________
Linuxppc-dev mailing list
Linuxppc-dev@lists.ozlabs.org
https://lists.ozlabs.org/listinfo/linuxppc-dev