diff options
author | Sascha Hauer <s.hauer@pengutronix.de> | 2015-01-27 21:29:41 +0100 |
---|---|---|
committer | Sascha Hauer <s.hauer@pengutronix.de> | 2015-01-28 08:18:43 +0100 |
commit | 478ea1c0b1e4db8275786ff7fb285d61d7697656 (patch) | |
tree | 49539757b594969e029a5a0585fa939ac829dc9b /drivers/gpio | |
parent | 2a0f2d46fd4b4e6d0da83dee944916a7ce7013b1 (diff) | |
download | barebox-478ea1c0b1e4db8275786ff7fb285d61d7697656.tar.gz barebox-478ea1c0b1e4db8275786ff7fb285d61d7697656.tar.xz |
ARM: MXS: Make gpio a driver
This turns the MXS gpio support into a driver.
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
Diffstat (limited to 'drivers/gpio')
-rw-r--r-- | drivers/gpio/Kconfig | 3 | ||||
-rw-r--r-- | drivers/gpio/Makefile | 1 | ||||
-rw-r--r-- | drivers/gpio/gpio-mxs.c | 186 |
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 *)®s); + 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)®s_mxs23, + }, { + .compatible = "fsl,imx28-gpio", + .data = (unsigned long)®s_mxs28, + }, { + /* sentinel */ + } +}; + +static struct platform_device_id mxs_gpio_ids[] = { + { + .name = "imx23-gpio", + .driver_data = (unsigned long)®s_mxs23, + }, { + .name = "imx28-gpio", + .driver_data = (unsigned long)®s_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); |