ARM: MXS: Make gpio a driver

This turns the MXS gpio support into a driver.

Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>

3 files changed, 190 insertions, 0 deletions

diff --git a/drivers/gpio/Kconfig b/drivers/gpio/Kconfig
index 0ca7df450a..c8b1efb1f2 100644
--- a/drivers/gpio/Kconfig
+++ b/drivers/gpio/Kconfig
@@ -41,6 +41,9 @@ config GPIO_GENERIC_PLATFORM
 config GPIO_IMX
 	def_bool ARCH_IMX
 
+config GPIO_MXS
+	def_bool ARCH_MXS
+
 config GPIO_JZ4740
 	bool "GPIO support for Ingenic SoCs"
 	depends on MACH_MIPS_XBURST
diff --git a/drivers/gpio/Makefile b/drivers/gpio/Makefile
index 510d146ff5..508e228bac 100644
--- a/drivers/gpio/Makefile
+++ b/drivers/gpio/Makefile
@@ -6,6 +6,7 @@ obj-$(CONFIG_GPIO_CLPS711X)	+= gpio-clps711x.o
 obj-$(CONFIG_GPIO_DIGIC)	+= gpio-digic.o
 obj-$(CONFIG_GPIO_GENERIC)	+= gpio-generic.o
 obj-$(CONFIG_GPIO_IMX)		+= gpio-imx.o
+obj-$(CONFIG_GPIO_MXS)		+= gpio-mxs.o
 obj-$(CONFIG_GPIO_JZ4740)	+= gpio-jz4740.o
 obj-$(CONFIG_GPIO_MALTA_FPGA_I2C) += gpio-malta-fpga-i2c.o
 obj-$(CONFIG_GPIO_ORION)	+= gpio-orion.o
diff --git a/drivers/gpio/gpio-mxs.c b/drivers/gpio/gpio-mxs.c
new file mode 100644
index 0000000000..30f9589831
--- /dev/null
+++ b/drivers/gpio/gpio-mxs.c
@@ -0,0 +1,186 @@
+/*
+ * Freescale MXS gpio support
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#include <common.h>
+#include <errno.h>
+#include <io.h>
+#include <of.h>
+#include <gpio.h>
+#include <init.h>
+#include <stmp-device.h>
+#include <linux/err.h>
+
+struct mxs_gpio_chip {
+	void __iomem *base;
+	void __iomem *din;
+	void __iomem *doe;
+	void __iomem *dout;
+	struct gpio_chip chip;
+	struct mxs_gpio_regs *regs;
+};
+
+struct mxs_gpio_regs {
+	unsigned int din;
+	unsigned int doe;
+	unsigned int dout;
+};
+
+static struct mxs_gpio_regs regs_mxs23 = {
+	.din = 0x0600,
+	.dout = 0x0500,
+	.doe = 0x0700,
+};
+
+static struct mxs_gpio_regs regs_mxs28 = {
+	.din = 0x0900,
+	.dout = 0x0700,
+	.doe = 0x0b00,
+};
+
+static void mxs_gpio_set_value(struct gpio_chip *chip, unsigned gpio, int value)
+{
+	struct mxs_gpio_chip *mxsgpio = container_of(chip, struct mxs_gpio_chip, chip);
+
+	if (value)
+		writel(0x1 << gpio, mxsgpio->dout + STMP_OFFSET_REG_SET);
+	else
+		writel(0x1 << gpio, mxsgpio->dout + STMP_OFFSET_REG_CLR);
+}
+
+static int mxs_gpio_direction_input(struct gpio_chip *chip, unsigned gpio)
+{
+	struct mxs_gpio_chip *mxsgpio = container_of(chip, struct mxs_gpio_chip, chip);
+
+	writel(0x1 << gpio, mxsgpio->doe + STMP_OFFSET_REG_CLR);
+
+	return 0;
+}
+
+
+static int mxs_gpio_direction_output(struct gpio_chip *chip, unsigned gpio, int value)
+{
+	struct mxs_gpio_chip *mxsgpio = container_of(chip, struct mxs_gpio_chip, chip);
+
+	mxs_gpio_set_value(chip, gpio, value);
+	writel(0x1 << gpio, mxsgpio->doe + STMP_OFFSET_REG_SET);
+
+	return 0;
+}
+
+static int mxs_gpio_get_value(struct gpio_chip *chip, unsigned gpio)
+{
+	struct mxs_gpio_chip *mxsgpio = container_of(chip, struct mxs_gpio_chip, chip);
+
+	if (readl(mxsgpio->din) & (1 << gpio))
+		return 1;
+	else
+		return 0;
+}
+
+static int mxs_get_direction(struct gpio_chip *chip, unsigned gpio)
+{
+	struct mxs_gpio_chip *mxsgpio = container_of(chip, struct mxs_gpio_chip, chip);
+
+	if (readl(mxsgpio->doe) & (1 << gpio))
+		return GPIOF_DIR_OUT;
+	else
+		return GPIOF_DIR_IN;
+}
+
+static struct gpio_ops mxs_gpio_ops = {
+	.direction_input = mxs_gpio_direction_input,
+	.direction_output = mxs_gpio_direction_output,
+	.get = mxs_gpio_get_value,
+	.set = mxs_gpio_set_value,
+	.get_direction = mxs_get_direction,
+};
+
+static int mxs_gpio_probe(struct device_d *dev)
+{
+	struct mxs_gpio_chip *mxsgpio;
+	struct mxs_gpio_regs *regs;
+	int ret, id;
+
+	ret = dev_get_drvdata(dev, (unsigned long *)&regs);
+	if (ret)
+		return ret;
+
+	mxsgpio = xzalloc(sizeof(*mxsgpio));
+	mxsgpio->chip.ops = &mxs_gpio_ops;
+	if (dev->id < 0) {
+		id = of_alias_get_id(dev->device_node, "gpio");
+		if (id < 0)
+			return id;
+		mxsgpio->base = dev_get_mem_region(dev->parent, 0);
+		mxsgpio->chip.base = id * 32;
+	} else {
+		id = dev->id;
+		mxsgpio->base = dev_get_mem_region(dev, 0);
+		mxsgpio->chip.base = dev->id * 32;
+	}
+
+	if (IS_ERR(mxsgpio->base))
+		return PTR_ERR(mxsgpio->base);
+
+	mxsgpio->doe = mxsgpio->base + regs->doe + id * 0x10;
+	mxsgpio->dout = mxsgpio->base + regs->dout + id * 0x10;
+	mxsgpio->din = mxsgpio->base + regs->din + id * 0x10;
+
+	mxsgpio->chip.ngpio = 32;
+	mxsgpio->chip.dev = dev;
+	mxsgpio->regs = regs;
+	gpiochip_add(&mxsgpio->chip);
+
+	dev_dbg(dev, "probed gpiochip%d with base %d\n", dev->id, mxsgpio->chip.base);
+
+	return 0;
+}
+
+static __maybe_unused struct of_device_id mxs_gpio_dt_ids[] = {
+	{
+		.compatible = "fsl,imx23-gpio",
+		.data = (unsigned long)&regs_mxs23,
+	}, {
+		.compatible = "fsl,imx28-gpio",
+		.data = (unsigned long)&regs_mxs28,
+	}, {
+		/* sentinel */
+	}
+};
+
+static struct platform_device_id mxs_gpio_ids[] = {
+	{
+		.name = "imx23-gpio",
+		.driver_data = (unsigned long)&regs_mxs23,
+	}, {
+		.name = "imx28-gpio",
+		.driver_data = (unsigned long)&regs_mxs28,
+	}, {
+		/* sentinel */
+	},
+};
+
+static struct driver_d mxs_gpio_driver = {
+	.name = "gpio-mxs",
+	.probe = mxs_gpio_probe,
+	.of_compatible = DRV_OF_COMPAT(mxs_gpio_dt_ids),
+	.id_table = mxs_gpio_ids,
+};
+
+static int mxs_gpio_add(void)
+{
+	platform_driver_register(&mxs_gpio_driver);
+	return 0;
+}
+core_initcall(mxs_gpio_add);