adm8668: rename files to files-3.3

[openwrt/openwrt.git] / target / linux / adm8668 / files-3.3 / arch / mips / adm8668 / gpio.c

diff --git a/target/linux/adm8668/files-3.3/arch/mips/adm8668/gpio.c b/target/linux/adm8668/files-3.3/arch/mips/adm8668/gpio.c
new file mode 100644 (file)
index 0000000..fb39f7f
--- /dev/null
+++ b/target/linux/adm8668/files-3.3/arch/mips/adm8668/gpio.c
@@ -0,0 +1,123 @@
+/*
+ * Infineon/ADMTek ADM8668 WildPass GPIO support
+ *
+ * Copyright (C) 2012 Florian Fainelli <florian@openwrt.org>
+ *
+ * Licensed under the terms of GPLv2.
+ *
+ */
+#include <linux/kernel.h>
+#include <linux/gpio.h>
+#include <linux/io.h>
+
+#include <adm8668.h>
+
+#define GPIO_MASK      0x3f
+
+#define GPIO_IN_OFS    0
+#define GPIO_OUT_OFS   6
+#define GPIO_OE_OFS    12
+
+struct adm8668_gpio_chip {
+       void __iomem    *base;
+       struct gpio_chip chip;
+};
+
+static int adm8668_gpio_dir_out(struct gpio_chip *chip,
+                               unsigned offset, int value)
+{
+       struct adm8668_gpio_chip *c =
+               container_of(chip, struct adm8668_gpio_chip, chip);
+       u32 mask;
+
+       /* clear input, set output enable and output value */
+       mask = __raw_readl(c->base);
+       mask &= ~(1 << offset);
+       mask |= (1 << (offset + GPIO_OE_OFS));
+       if (value)
+               mask |= (1 << (offset + GPIO_OUT_OFS));
+       else
+               mask &= ~(1 << (offset + GPIO_OUT_OFS));
+       __raw_writel(mask, c->base);
+
+       return 0;
+}
+
+static int adm8668_gpio_dir_in(struct gpio_chip *chip,
+                               unsigned offset)
+{
+       struct adm8668_gpio_chip *c =
+               container_of(chip, struct adm8668_gpio_chip, chip);
+       u32 mask;
+
+       mask = __raw_readl(c->base);
+       mask &= ~(((1 << (offset + GPIO_OE_OFS)) | (1 << (offset + GPIO_OUT_OFS))));
+       mask |= (1 << offset);
+       __raw_writel(mask, c->base);
+
+       return 0;
+}
+
+static void adm8668_gpio_set(struct gpio_chip *chip,
+                               unsigned offset, int value)
+{
+       struct adm8668_gpio_chip *c =
+               container_of(chip, struct adm8668_gpio_chip, chip);
+       u32 mask;
+
+       mask = __raw_readl(c->base);
+       if (value)
+               mask |= (1 << (offset + GPIO_OUT_OFS));
+       else
+               mask &= ~(1 << (offset + GPIO_OUT_OFS));
+       __raw_writel(mask, c->base);
+}
+
+static int adm8668_gpio_get(struct gpio_chip *chip,
+                               unsigned offset)
+{
+       struct adm8668_gpio_chip *c =
+               container_of(chip, struct adm8668_gpio_chip, chip);
+       u32 value;
+
+       value = __raw_readl(c->base) & GPIO_MASK;
+
+       return value & (1 << offset);
+}
+
+static struct adm8668_gpio_chip adm8668_gpio_cpu = {
+       .base = (void __iomem *)KSEG1ADDR(ADM8668_CONFIG_BASE + CRGPIO_REG),
+       .chip = {
+               .label                  = "adm8668-cpu-gpio",
+               .direction_output       = adm8668_gpio_dir_out,
+               .direction_input        = adm8668_gpio_dir_in,
+               .set                    = adm8668_gpio_set,
+               .get                    = adm8668_gpio_get,
+               .ngpio                  = 6,
+       },
+};
+
+static struct adm8668_gpio_chip adm8668_gpio_wlan = {
+       .base = (void __iomem *)KSEG1ADDR(ADM8668_WLAN_BASE + GPIO_REG),
+       .chip = {
+               .label                  = "adm8668-wlan-gpio",
+               .direction_output       = adm8668_gpio_dir_out,
+               .direction_input        = adm8668_gpio_dir_in,
+               .set                    = adm8668_gpio_set,
+               .get                    = adm8668_gpio_get,
+               .ngpio                  = 6,
+               .base                   = 6,
+       },
+};
+
+static int __init adm8668_gpio_init(void)
+{
+       int ret;
+
+       ret = gpiochip_add(&adm8668_gpio_cpu.chip);
+       if (ret)
+               return ret;
+
+       return gpiochip_add(&adm8668_gpio_wlan.chip);
+}
+arch_initcall(adm8668_gpio_init);