drivers/gpio/gpio-lpc32xx.c - kernel/msm-4.9 - Gitiles

 /*
  * GPIO driver for LPC32xx SoC
  *
  * Author: Kevin Wells <kevin.wells@nxp.com>
  *
  * Copyright (C) 2010 NXP Semiconductors
  *
  * 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 <linux/kernel.h>
 #include <linux/init.h>
 #include <linux/io.h>
 #include <linux/errno.h>
 #include <linux/gpio.h>
 #include <linux/of.h>
 #include <linux/of_gpio.h>
 #include <linux/platform_device.h>
 #include <linux/module.h>
 #include <linux/platform_data/gpio-lpc32xx.h>

 #include <mach/hardware.h>
 #include <mach/platform.h>

 #define LPC32XX_GPIO_P3_INP_STATE		_GPREG(0x000)
 #define LPC32XX_GPIO_P3_OUTP_SET		_GPREG(0x004)
 #define LPC32XX_GPIO_P3_OUTP_CLR		_GPREG(0x008)
 #define LPC32XX_GPIO_P3_OUTP_STATE		_GPREG(0x00C)
 #define LPC32XX_GPIO_P2_DIR_SET			_GPREG(0x010)
 #define LPC32XX_GPIO_P2_DIR_CLR			_GPREG(0x014)
 #define LPC32XX_GPIO_P2_DIR_STATE		_GPREG(0x018)
 #define LPC32XX_GPIO_P2_INP_STATE		_GPREG(0x01C)
 #define LPC32XX_GPIO_P2_OUTP_SET		_GPREG(0x020)
 #define LPC32XX_GPIO_P2_OUTP_CLR		_GPREG(0x024)
 #define LPC32XX_GPIO_P2_MUX_SET			_GPREG(0x028)
 #define LPC32XX_GPIO_P2_MUX_CLR			_GPREG(0x02C)
 #define LPC32XX_GPIO_P2_MUX_STATE		_GPREG(0x030)
 #define LPC32XX_GPIO_P0_INP_STATE		_GPREG(0x040)
 #define LPC32XX_GPIO_P0_OUTP_SET		_GPREG(0x044)
 #define LPC32XX_GPIO_P0_OUTP_CLR		_GPREG(0x048)
 #define LPC32XX_GPIO_P0_OUTP_STATE		_GPREG(0x04C)
 #define LPC32XX_GPIO_P0_DIR_SET			_GPREG(0x050)
 #define LPC32XX_GPIO_P0_DIR_CLR			_GPREG(0x054)
 #define LPC32XX_GPIO_P0_DIR_STATE		_GPREG(0x058)
 #define LPC32XX_GPIO_P1_INP_STATE		_GPREG(0x060)
 #define LPC32XX_GPIO_P1_OUTP_SET		_GPREG(0x064)
 #define LPC32XX_GPIO_P1_OUTP_CLR		_GPREG(0x068)
 #define LPC32XX_GPIO_P1_OUTP_STATE		_GPREG(0x06C)
 #define LPC32XX_GPIO_P1_DIR_SET			_GPREG(0x070)
 #define LPC32XX_GPIO_P1_DIR_CLR			_GPREG(0x074)
 #define LPC32XX_GPIO_P1_DIR_STATE		_GPREG(0x078)

 #define GPIO012_PIN_TO_BIT(x)			(1 << (x))
 #define GPIO3_PIN_TO_BIT(x)			(1 << ((x) + 25))
 #define GPO3_PIN_TO_BIT(x)			(1 << (x))
 #define GPIO012_PIN_IN_SEL(x, y)		(((x) >> (y)) & 1)
 #define GPIO3_PIN_IN_SHIFT(x)			((x) == 5 ? 24 : 10 + (x))
 #define GPIO3_PIN_IN_SEL(x, y)			(((x) >> GPIO3_PIN_IN_SHIFT(y)) & 1)
 #define GPIO3_PIN5_IN_SEL(x)			(((x) >> 24) & 1)
 #define GPI3_PIN_IN_SEL(x, y)			(((x) >> (y)) & 1)
 #define GPO3_PIN_IN_SEL(x, y)			(((x) >> (y)) & 1)

 struct gpio_regs {
 	void __iomem *inp_state;
 	void __iomem *outp_state;
 	void __iomem *outp_set;
 	void __iomem *outp_clr;
 	void __iomem *dir_set;
 	void __iomem *dir_clr;
 };

 /*
  * GPIO names
  */
 static const char *gpio_p0_names[LPC32XX_GPIO_P0_MAX] = {
 	"p0.0", "p0.1", "p0.2", "p0.3",
 	"p0.4", "p0.5", "p0.6", "p0.7"
 };

 static const char *gpio_p1_names[LPC32XX_GPIO_P1_MAX] = {
 	"p1.0", "p1.1", "p1.2", "p1.3",
 	"p1.4", "p1.5", "p1.6", "p1.7",
 	"p1.8", "p1.9", "p1.10", "p1.11",
 	"p1.12", "p1.13", "p1.14", "p1.15",
 	"p1.16", "p1.17", "p1.18", "p1.19",
 	"p1.20", "p1.21", "p1.22", "p1.23",
 };

 static const char *gpio_p2_names[LPC32XX_GPIO_P2_MAX] = {
 	"p2.0", "p2.1", "p2.2", "p2.3",
 	"p2.4", "p2.5", "p2.6", "p2.7",
 	"p2.8", "p2.9", "p2.10", "p2.11",
 	"p2.12"
 };

 static const char *gpio_p3_names[LPC32XX_GPIO_P3_MAX] = {
 	"gpio00", "gpio01", "gpio02", "gpio03",
 	"gpio04", "gpio05"
 };

 static const char *gpi_p3_names[LPC32XX_GPI_P3_MAX] = {
 	"gpi00", "gpi01", "gpi02", "gpi03",
 	"gpi04", "gpi05", "gpi06", "gpi07",
 	"gpi08", "gpi09",  NULL,    NULL,
 	 NULL,    NULL,    NULL,   "gpi15",
 	"gpi16", "gpi17", "gpi18", "gpi19",
 	"gpi20", "gpi21", "gpi22", "gpi23",
 	"gpi24", "gpi25", "gpi26", "gpi27",
 	"gpi28"
 };

 static const char *gpo_p3_names[LPC32XX_GPO_P3_MAX] = {
 	"gpo00", "gpo01", "gpo02", "gpo03",
 	"gpo04", "gpo05", "gpo06", "gpo07",
 	"gpo08", "gpo09", "gpo10", "gpo11",
 	"gpo12", "gpo13", "gpo14", "gpo15",
 	"gpo16", "gpo17", "gpo18", "gpo19",
 	"gpo20", "gpo21", "gpo22", "gpo23"
 };

 static struct gpio_regs gpio_grp_regs_p0 = {
 	.inp_state	= LPC32XX_GPIO_P0_INP_STATE,
 	.outp_set	= LPC32XX_GPIO_P0_OUTP_SET,
 	.outp_clr	= LPC32XX_GPIO_P0_OUTP_CLR,
 	.dir_set	= LPC32XX_GPIO_P0_DIR_SET,
 	.dir_clr	= LPC32XX_GPIO_P0_DIR_CLR,
 };

 static struct gpio_regs gpio_grp_regs_p1 = {
 	.inp_state	= LPC32XX_GPIO_P1_INP_STATE,
 	.outp_set	= LPC32XX_GPIO_P1_OUTP_SET,
 	.outp_clr	= LPC32XX_GPIO_P1_OUTP_CLR,
 	.dir_set	= LPC32XX_GPIO_P1_DIR_SET,
 	.dir_clr	= LPC32XX_GPIO_P1_DIR_CLR,
 };

 static struct gpio_regs gpio_grp_regs_p2 = {
 	.inp_state	= LPC32XX_GPIO_P2_INP_STATE,
 	.outp_set	= LPC32XX_GPIO_P2_OUTP_SET,
 	.outp_clr	= LPC32XX_GPIO_P2_OUTP_CLR,
 	.dir_set	= LPC32XX_GPIO_P2_DIR_SET,
 	.dir_clr	= LPC32XX_GPIO_P2_DIR_CLR,
 };

 static struct gpio_regs gpio_grp_regs_p3 = {
 	.inp_state	= LPC32XX_GPIO_P3_INP_STATE,
 	.outp_state	= LPC32XX_GPIO_P3_OUTP_STATE,
 	.outp_set	= LPC32XX_GPIO_P3_OUTP_SET,
 	.outp_clr	= LPC32XX_GPIO_P3_OUTP_CLR,
 	.dir_set	= LPC32XX_GPIO_P2_DIR_SET,
 	.dir_clr	= LPC32XX_GPIO_P2_DIR_CLR,
 };

 struct lpc32xx_gpio_chip {
 	struct gpio_chip	chip;
 	struct gpio_regs	*gpio_grp;
 };

 static void __set_gpio_dir_p012(struct lpc32xx_gpio_chip *group,
 	unsigned pin, int input)
 {
 	if (input)
 		__raw_writel(GPIO012_PIN_TO_BIT(pin),
 			group->gpio_grp->dir_clr);
 	else
 		__raw_writel(GPIO012_PIN_TO_BIT(pin),
 			group->gpio_grp->dir_set);
 }

 static void __set_gpio_dir_p3(struct lpc32xx_gpio_chip *group,
 	unsigned pin, int input)
 {
 	u32 u = GPIO3_PIN_TO_BIT(pin);

 	if (input)
 		__raw_writel(u, group->gpio_grp->dir_clr);
 	else
 		__raw_writel(u, group->gpio_grp->dir_set);
 }

 static void __set_gpio_level_p012(struct lpc32xx_gpio_chip *group,
 	unsigned pin, int high)
 {
 	if (high)
 		__raw_writel(GPIO012_PIN_TO_BIT(pin),
 			group->gpio_grp->outp_set);
 	else
 		__raw_writel(GPIO012_PIN_TO_BIT(pin),
 			group->gpio_grp->outp_clr);
 }

 static void __set_gpio_level_p3(struct lpc32xx_gpio_chip *group,
 	unsigned pin, int high)
 {
 	u32 u = GPIO3_PIN_TO_BIT(pin);

 	if (high)
 		__raw_writel(u, group->gpio_grp->outp_set);
 	else
 		__raw_writel(u, group->gpio_grp->outp_clr);
 }

 static void __set_gpo_level_p3(struct lpc32xx_gpio_chip *group,
 	unsigned pin, int high)
 {
 	if (high)
 		__raw_writel(GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_set);
 	else
 		__raw_writel(GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_clr);
 }

 static int __get_gpio_state_p012(struct lpc32xx_gpio_chip *group,
 	unsigned pin)
 {
 	return GPIO012_PIN_IN_SEL(__raw_readl(group->gpio_grp->inp_state),
 		pin);
 }

 static int __get_gpio_state_p3(struct lpc32xx_gpio_chip *group,
 	unsigned pin)
 {
 	int state = __raw_readl(group->gpio_grp->inp_state);

 	/*
 	 * P3 GPIO pin input mapping is not contiguous, GPIOP3-0..4 is mapped
 	 * to bits 10..14, while GPIOP3-5 is mapped to bit 24.
 	 */
 	return GPIO3_PIN_IN_SEL(state, pin);
 }

 static int __get_gpi_state_p3(struct lpc32xx_gpio_chip *group,
 	unsigned pin)
 {
 	return GPI3_PIN_IN_SEL(__raw_readl(group->gpio_grp->inp_state), pin);
 }

 static int __get_gpo_state_p3(struct lpc32xx_gpio_chip *group,
 	unsigned pin)
 {
 	return GPO3_PIN_IN_SEL(__raw_readl(group->gpio_grp->outp_state), pin);
 }

 /*
  * GPIO primitives.
  */
 static int lpc32xx_gpio_dir_input_p012(struct gpio_chip *chip,
 	unsigned pin)
 {
 	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

 	__set_gpio_dir_p012(group, pin, 1);

 	return 0;
 }

 static int lpc32xx_gpio_dir_input_p3(struct gpio_chip *chip,
 	unsigned pin)
 {
 	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

 	__set_gpio_dir_p3(group, pin, 1);

 	return 0;
 }

 static int lpc32xx_gpio_dir_in_always(struct gpio_chip *chip,
 	unsigned pin)
 {
 	return 0;
 }

 static int lpc32xx_gpio_get_value_p012(struct gpio_chip *chip, unsigned pin)
 {
 	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

 	return !!__get_gpio_state_p012(group, pin);
 }

 static int lpc32xx_gpio_get_value_p3(struct gpio_chip *chip, unsigned pin)
 {
 	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

 	return !!__get_gpio_state_p3(group, pin);
 }

 static int lpc32xx_gpi_get_value(struct gpio_chip *chip, unsigned pin)
 {
 	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

 	return !!__get_gpi_state_p3(group, pin);
 }

 static int lpc32xx_gpio_dir_output_p012(struct gpio_chip *chip, unsigned pin,
 	int value)
 {
 	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

 	__set_gpio_level_p012(group, pin, value);
 	__set_gpio_dir_p012(group, pin, 0);

 	return 0;
 }

 static int lpc32xx_gpio_dir_output_p3(struct gpio_chip *chip, unsigned pin,
 	int value)
 {
 	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

 	__set_gpio_level_p3(group, pin, value);
 	__set_gpio_dir_p3(group, pin, 0);

 	return 0;
 }

 static int lpc32xx_gpio_dir_out_always(struct gpio_chip *chip, unsigned pin,
 	int value)
 {
 	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

 	__set_gpo_level_p3(group, pin, value);
 	return 0;
 }

 static void lpc32xx_gpio_set_value_p012(struct gpio_chip *chip, unsigned pin,
 	int value)
 {
 	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

 	__set_gpio_level_p012(group, pin, value);
 }

 static void lpc32xx_gpio_set_value_p3(struct gpio_chip *chip, unsigned pin,
 	int value)
 {
 	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

 	__set_gpio_level_p3(group, pin, value);
 }

 static void lpc32xx_gpo_set_value(struct gpio_chip *chip, unsigned pin,
 	int value)
 {
 	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

 	__set_gpo_level_p3(group, pin, value);
 }

 static int lpc32xx_gpo_get_value(struct gpio_chip *chip, unsigned pin)
 {
 	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

 	return !!__get_gpo_state_p3(group, pin);
 }

 static int lpc32xx_gpio_request(struct gpio_chip *chip, unsigned pin)
 {
 	if (pin < chip->ngpio)
 		return 0;

 	return -EINVAL;
 }

 static int lpc32xx_gpio_to_irq_p01(struct gpio_chip *chip, unsigned offset)
 {
 	return -ENXIO;
 }

 static int lpc32xx_gpio_to_irq_gpio_p3(struct gpio_chip *chip, unsigned offset)
 {
 	return -ENXIO;
 }

 static int lpc32xx_gpio_to_irq_gpi_p3(struct gpio_chip *chip, unsigned offset)
 {
 	return -ENXIO;
 }

 static struct lpc32xx_gpio_chip lpc32xx_gpiochip[] = {
 	{
 		.chip = {
 			.label			= "gpio_p0",
 			.direction_input	= lpc32xx_gpio_dir_input_p012,
 			.get			= lpc32xx_gpio_get_value_p012,
 			.direction_output	= lpc32xx_gpio_dir_output_p012,
 			.set			= lpc32xx_gpio_set_value_p012,
 			.request		= lpc32xx_gpio_request,
 			.to_irq			= lpc32xx_gpio_to_irq_p01,
 			.base			= LPC32XX_GPIO_P0_GRP,
 			.ngpio			= LPC32XX_GPIO_P0_MAX,
 			.names			= gpio_p0_names,
 			.can_sleep		= false,
 		},
 		.gpio_grp = &gpio_grp_regs_p0,
 	},
 	{
 		.chip = {
 			.label			= "gpio_p1",
 			.direction_input	= lpc32xx_gpio_dir_input_p012,
 			.get			= lpc32xx_gpio_get_value_p012,
 			.direction_output	= lpc32xx_gpio_dir_output_p012,
 			.set			= lpc32xx_gpio_set_value_p012,
 			.request		= lpc32xx_gpio_request,
 			.to_irq			= lpc32xx_gpio_to_irq_p01,
 			.base			= LPC32XX_GPIO_P1_GRP,
 			.ngpio			= LPC32XX_GPIO_P1_MAX,
 			.names			= gpio_p1_names,
 			.can_sleep		= false,
 		},
 		.gpio_grp = &gpio_grp_regs_p1,
 	},
 	{
 		.chip = {
 			.label			= "gpio_p2",
 			.direction_input	= lpc32xx_gpio_dir_input_p012,
 			.get			= lpc32xx_gpio_get_value_p012,
 			.direction_output	= lpc32xx_gpio_dir_output_p012,
 			.set			= lpc32xx_gpio_set_value_p012,
 			.request		= lpc32xx_gpio_request,
 			.base			= LPC32XX_GPIO_P2_GRP,
 			.ngpio			= LPC32XX_GPIO_P2_MAX,
 			.names			= gpio_p2_names,
 			.can_sleep		= false,
 		},
 		.gpio_grp = &gpio_grp_regs_p2,
 	},
 	{
 		.chip = {
 			.label			= "gpio_p3",
 			.direction_input	= lpc32xx_gpio_dir_input_p3,
 			.get			= lpc32xx_gpio_get_value_p3,
 			.direction_output	= lpc32xx_gpio_dir_output_p3,
 			.set			= lpc32xx_gpio_set_value_p3,
 			.request		= lpc32xx_gpio_request,
 			.to_irq			= lpc32xx_gpio_to_irq_gpio_p3,
 			.base			= LPC32XX_GPIO_P3_GRP,
 			.ngpio			= LPC32XX_GPIO_P3_MAX,
 			.names			= gpio_p3_names,
 			.can_sleep		= false,
 		},
 		.gpio_grp = &gpio_grp_regs_p3,
 	},
 	{
 		.chip = {
 			.label			= "gpi_p3",
 			.direction_input	= lpc32xx_gpio_dir_in_always,
 			.get			= lpc32xx_gpi_get_value,
 			.request		= lpc32xx_gpio_request,
 			.to_irq			= lpc32xx_gpio_to_irq_gpi_p3,
 			.base			= LPC32XX_GPI_P3_GRP,
 			.ngpio			= LPC32XX_GPI_P3_MAX,
 			.names			= gpi_p3_names,
 			.can_sleep		= false,
 		},
 		.gpio_grp = &gpio_grp_regs_p3,
 	},
 	{
 		.chip = {
 			.label			= "gpo_p3",
 			.direction_output	= lpc32xx_gpio_dir_out_always,
 			.set			= lpc32xx_gpo_set_value,
 			.get			= lpc32xx_gpo_get_value,
 			.request		= lpc32xx_gpio_request,
 			.base			= LPC32XX_GPO_P3_GRP,
 			.ngpio			= LPC32XX_GPO_P3_MAX,
 			.names			= gpo_p3_names,
 			.can_sleep		= false,
 		},
 		.gpio_grp = &gpio_grp_regs_p3,
 	},
 };

 static int lpc32xx_of_xlate(struct gpio_chip *gc,
 			    const struct of_phandle_args *gpiospec, u32 *flags)
 {
 	/* Is this the correct bank? */
 	u32 bank = gpiospec->args[0];
 	if ((bank >= ARRAY_SIZE(lpc32xx_gpiochip) ||
 	    (gc != &lpc32xx_gpiochip[bank].chip)))
 		return -EINVAL;

 	if (flags)
 		*flags = gpiospec->args[2];
 	return gpiospec->args[1];
 }

 static int lpc32xx_gpio_probe(struct platform_device *pdev)
 {
 	int i;

 	for (i = 0; i < ARRAY_SIZE(lpc32xx_gpiochip); i++) {
 		if (pdev->dev.of_node) {
 			lpc32xx_gpiochip[i].chip.of_xlate = lpc32xx_of_xlate;
 			lpc32xx_gpiochip[i].chip.of_gpio_n_cells = 3;
 			lpc32xx_gpiochip[i].chip.of_node = pdev->dev.of_node;
 		}
 		devm_gpiochip_add_data(&pdev->dev, &lpc32xx_gpiochip[i].chip,
 				  &lpc32xx_gpiochip[i]);
 	}

 	return 0;
 }

 #ifdef CONFIG_OF
 static const struct of_device_id lpc32xx_gpio_of_match[] = {
 	{ .compatible = "nxp,lpc3220-gpio", },
 	{ },
 };
 #endif

 static struct platform_driver lpc32xx_gpio_driver = {
 	.driver		= {
 		.name	= "lpc32xx-gpio",
 		.of_match_table = of_match_ptr(lpc32xx_gpio_of_match),
 	},
 	.probe		= lpc32xx_gpio_probe,
 };

 module_platform_driver(lpc32xx_gpio_driver);
	/*
	* GPIO driver for LPC32xx SoC
	*
	* Author: Kevin Wells <kevin.wells@nxp.com>
	*
	* Copyright (C) 2010 NXP Semiconductors
	*
	* 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 <linux/kernel.h>
	#include <linux/init.h>
	#include <linux/io.h>
	#include <linux/errno.h>
	#include <linux/gpio.h>
	#include <linux/of.h>
	#include <linux/of_gpio.h>
	#include <linux/platform_device.h>
	#include <linux/module.h>
	#include <linux/platform_data/gpio-lpc32xx.h>

	#include <mach/hardware.h>
	#include <mach/platform.h>

	#define LPC32XX_GPIO_P3_INP_STATE _GPREG(0x000)
	#define LPC32XX_GPIO_P3_OUTP_SET _GPREG(0x004)
	#define LPC32XX_GPIO_P3_OUTP_CLR _GPREG(0x008)
	#define LPC32XX_GPIO_P3_OUTP_STATE _GPREG(0x00C)
	#define LPC32XX_GPIO_P2_DIR_SET _GPREG(0x010)
	#define LPC32XX_GPIO_P2_DIR_CLR _GPREG(0x014)
	#define LPC32XX_GPIO_P2_DIR_STATE _GPREG(0x018)
	#define LPC32XX_GPIO_P2_INP_STATE _GPREG(0x01C)
	#define LPC32XX_GPIO_P2_OUTP_SET _GPREG(0x020)
	#define LPC32XX_GPIO_P2_OUTP_CLR _GPREG(0x024)
	#define LPC32XX_GPIO_P2_MUX_SET _GPREG(0x028)
	#define LPC32XX_GPIO_P2_MUX_CLR _GPREG(0x02C)
	#define LPC32XX_GPIO_P2_MUX_STATE _GPREG(0x030)
	#define LPC32XX_GPIO_P0_INP_STATE _GPREG(0x040)
	#define LPC32XX_GPIO_P0_OUTP_SET _GPREG(0x044)
	#define LPC32XX_GPIO_P0_OUTP_CLR _GPREG(0x048)
	#define LPC32XX_GPIO_P0_OUTP_STATE _GPREG(0x04C)
	#define LPC32XX_GPIO_P0_DIR_SET _GPREG(0x050)
	#define LPC32XX_GPIO_P0_DIR_CLR _GPREG(0x054)
	#define LPC32XX_GPIO_P0_DIR_STATE _GPREG(0x058)
	#define LPC32XX_GPIO_P1_INP_STATE _GPREG(0x060)
	#define LPC32XX_GPIO_P1_OUTP_SET _GPREG(0x064)
	#define LPC32XX_GPIO_P1_OUTP_CLR _GPREG(0x068)
	#define LPC32XX_GPIO_P1_OUTP_STATE _GPREG(0x06C)
	#define LPC32XX_GPIO_P1_DIR_SET _GPREG(0x070)
	#define LPC32XX_GPIO_P1_DIR_CLR _GPREG(0x074)
	#define LPC32XX_GPIO_P1_DIR_STATE _GPREG(0x078)

	#define GPIO012_PIN_TO_BIT(x) (1 << (x))
	#define GPIO3_PIN_TO_BIT(x) (1 << ((x) + 25))
	#define GPO3_PIN_TO_BIT(x) (1 << (x))
	#define GPIO012_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
	#define GPIO3_PIN_IN_SHIFT(x) ((x) == 5 ? 24 : 10 + (x))
	#define GPIO3_PIN_IN_SEL(x, y) (((x) >> GPIO3_PIN_IN_SHIFT(y)) & 1)
	#define GPIO3_PIN5_IN_SEL(x) (((x) >> 24) & 1)
	#define GPI3_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
	#define GPO3_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)

	struct gpio_regs {
	void __iomem *inp_state;
	void __iomem *outp_state;
	void __iomem *outp_set;
	void __iomem *outp_clr;
	void __iomem *dir_set;
	void __iomem *dir_clr;
	};

	/*
	* GPIO names
	*/
	static const char *gpio_p0_names[LPC32XX_GPIO_P0_MAX] = {
	"p0.0", "p0.1", "p0.2", "p0.3",
	"p0.4", "p0.5", "p0.6", "p0.7"
	};

	static const char *gpio_p1_names[LPC32XX_GPIO_P1_MAX] = {
	"p1.0", "p1.1", "p1.2", "p1.3",
	"p1.4", "p1.5", "p1.6", "p1.7",
	"p1.8", "p1.9", "p1.10", "p1.11",
	"p1.12", "p1.13", "p1.14", "p1.15",
	"p1.16", "p1.17", "p1.18", "p1.19",
	"p1.20", "p1.21", "p1.22", "p1.23",
	};

	static const char *gpio_p2_names[LPC32XX_GPIO_P2_MAX] = {
	"p2.0", "p2.1", "p2.2", "p2.3",
	"p2.4", "p2.5", "p2.6", "p2.7",
	"p2.8", "p2.9", "p2.10", "p2.11",
	"p2.12"
	};

	static const char *gpio_p3_names[LPC32XX_GPIO_P3_MAX] = {
	"gpio00", "gpio01", "gpio02", "gpio03",
	"gpio04", "gpio05"
	};

	static const char *gpi_p3_names[LPC32XX_GPI_P3_MAX] = {
	"gpi00", "gpi01", "gpi02", "gpi03",
	"gpi04", "gpi05", "gpi06", "gpi07",
	"gpi08", "gpi09", NULL, NULL,
	NULL, NULL, NULL, "gpi15",
	"gpi16", "gpi17", "gpi18", "gpi19",
	"gpi20", "gpi21", "gpi22", "gpi23",
	"gpi24", "gpi25", "gpi26", "gpi27",
	"gpi28"
	};

	static const char *gpo_p3_names[LPC32XX_GPO_P3_MAX] = {
	"gpo00", "gpo01", "gpo02", "gpo03",
	"gpo04", "gpo05", "gpo06", "gpo07",
	"gpo08", "gpo09", "gpo10", "gpo11",
	"gpo12", "gpo13", "gpo14", "gpo15",
	"gpo16", "gpo17", "gpo18", "gpo19",
	"gpo20", "gpo21", "gpo22", "gpo23"
	};

	static struct gpio_regs gpio_grp_regs_p0 = {
	.inp_state = LPC32XX_GPIO_P0_INP_STATE,
	.outp_set = LPC32XX_GPIO_P0_OUTP_SET,
	.outp_clr = LPC32XX_GPIO_P0_OUTP_CLR,
	.dir_set = LPC32XX_GPIO_P0_DIR_SET,
	.dir_clr = LPC32XX_GPIO_P0_DIR_CLR,
	};

	static struct gpio_regs gpio_grp_regs_p1 = {
	.inp_state = LPC32XX_GPIO_P1_INP_STATE,
	.outp_set = LPC32XX_GPIO_P1_OUTP_SET,
	.outp_clr = LPC32XX_GPIO_P1_OUTP_CLR,
	.dir_set = LPC32XX_GPIO_P1_DIR_SET,
	.dir_clr = LPC32XX_GPIO_P1_DIR_CLR,
	};

	static struct gpio_regs gpio_grp_regs_p2 = {
	.inp_state = LPC32XX_GPIO_P2_INP_STATE,
	.outp_set = LPC32XX_GPIO_P2_OUTP_SET,
	.outp_clr = LPC32XX_GPIO_P2_OUTP_CLR,
	.dir_set = LPC32XX_GPIO_P2_DIR_SET,
	.dir_clr = LPC32XX_GPIO_P2_DIR_CLR,
	};

	static struct gpio_regs gpio_grp_regs_p3 = {
	.inp_state = LPC32XX_GPIO_P3_INP_STATE,
	.outp_state = LPC32XX_GPIO_P3_OUTP_STATE,
	.outp_set = LPC32XX_GPIO_P3_OUTP_SET,
	.outp_clr = LPC32XX_GPIO_P3_OUTP_CLR,
	.dir_set = LPC32XX_GPIO_P2_DIR_SET,
	.dir_clr = LPC32XX_GPIO_P2_DIR_CLR,
	};

	struct lpc32xx_gpio_chip {
	struct gpio_chip chip;
	struct gpio_regs *gpio_grp;
	};

	static void __set_gpio_dir_p012(struct lpc32xx_gpio_chip *group,
	unsigned pin, int input)
	{
	if (input)
	__raw_writel(GPIO012_PIN_TO_BIT(pin),
	group->gpio_grp->dir_clr);
	else
	__raw_writel(GPIO012_PIN_TO_BIT(pin),
	group->gpio_grp->dir_set);
	}

	static void __set_gpio_dir_p3(struct lpc32xx_gpio_chip *group,
	unsigned pin, int input)
	{
	u32 u = GPIO3_PIN_TO_BIT(pin);

	if (input)
	__raw_writel(u, group->gpio_grp->dir_clr);
	else
	__raw_writel(u, group->gpio_grp->dir_set);
	}

	static void __set_gpio_level_p012(struct lpc32xx_gpio_chip *group,
	unsigned pin, int high)
	{
	if (high)
	__raw_writel(GPIO012_PIN_TO_BIT(pin),
	group->gpio_grp->outp_set);
	else
	__raw_writel(GPIO012_PIN_TO_BIT(pin),
	group->gpio_grp->outp_clr);
	}

	static void __set_gpio_level_p3(struct lpc32xx_gpio_chip *group,
	unsigned pin, int high)
	{
	u32 u = GPIO3_PIN_TO_BIT(pin);

	if (high)
	__raw_writel(u, group->gpio_grp->outp_set);
	else
	__raw_writel(u, group->gpio_grp->outp_clr);
	}

	static void __set_gpo_level_p3(struct lpc32xx_gpio_chip *group,
	unsigned pin, int high)
	{
	if (high)
	__raw_writel(GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_set);
	else
	__raw_writel(GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_clr);
	}

	static int __get_gpio_state_p012(struct lpc32xx_gpio_chip *group,
	unsigned pin)
	{
	return GPIO012_PIN_IN_SEL(__raw_readl(group->gpio_grp->inp_state),
	pin);
	}

	static int __get_gpio_state_p3(struct lpc32xx_gpio_chip *group,
	unsigned pin)
	{
	int state = __raw_readl(group->gpio_grp->inp_state);

	/*
	* P3 GPIO pin input mapping is not contiguous, GPIOP3-0..4 is mapped
	* to bits 10..14, while GPIOP3-5 is mapped to bit 24.
	*/
	return GPIO3_PIN_IN_SEL(state, pin);
	}

	static int __get_gpi_state_p3(struct lpc32xx_gpio_chip *group,
	unsigned pin)
	{
	return GPI3_PIN_IN_SEL(__raw_readl(group->gpio_grp->inp_state), pin);
	}

	static int __get_gpo_state_p3(struct lpc32xx_gpio_chip *group,
	unsigned pin)
	{
	return GPO3_PIN_IN_SEL(__raw_readl(group->gpio_grp->outp_state), pin);
	}

	/*
	* GPIO primitives.
	*/
	static int lpc32xx_gpio_dir_input_p012(struct gpio_chip *chip,
	unsigned pin)
	{
	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

	__set_gpio_dir_p012(group, pin, 1);

	return 0;
	}

	static int lpc32xx_gpio_dir_input_p3(struct gpio_chip *chip,
	unsigned pin)
	{
	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

	__set_gpio_dir_p3(group, pin, 1);

	return 0;
	}

	static int lpc32xx_gpio_dir_in_always(struct gpio_chip *chip,
	unsigned pin)
	{
	return 0;
	}

	static int lpc32xx_gpio_get_value_p012(struct gpio_chip *chip, unsigned pin)
	{
	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

	return !!__get_gpio_state_p012(group, pin);
	}

	static int lpc32xx_gpio_get_value_p3(struct gpio_chip *chip, unsigned pin)
	{
	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

	return !!__get_gpio_state_p3(group, pin);
	}

	static int lpc32xx_gpi_get_value(struct gpio_chip *chip, unsigned pin)
	{
	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

	return !!__get_gpi_state_p3(group, pin);
	}

	static int lpc32xx_gpio_dir_output_p012(struct gpio_chip *chip, unsigned pin,
	int value)
	{
	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

	__set_gpio_level_p012(group, pin, value);
	__set_gpio_dir_p012(group, pin, 0);

	return 0;
	}

	static int lpc32xx_gpio_dir_output_p3(struct gpio_chip *chip, unsigned pin,
	int value)
	{
	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

	__set_gpio_level_p3(group, pin, value);
	__set_gpio_dir_p3(group, pin, 0);

	return 0;
	}

	static int lpc32xx_gpio_dir_out_always(struct gpio_chip *chip, unsigned pin,
	int value)
	{
	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

	__set_gpo_level_p3(group, pin, value);
	return 0;
	}

	static void lpc32xx_gpio_set_value_p012(struct gpio_chip *chip, unsigned pin,
	int value)
	{
	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

	__set_gpio_level_p012(group, pin, value);
	}

	static void lpc32xx_gpio_set_value_p3(struct gpio_chip *chip, unsigned pin,
	int value)
	{
	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

	__set_gpio_level_p3(group, pin, value);
	}

	static void lpc32xx_gpo_set_value(struct gpio_chip *chip, unsigned pin,
	int value)
	{
	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

	__set_gpo_level_p3(group, pin, value);
	}

	static int lpc32xx_gpo_get_value(struct gpio_chip *chip, unsigned pin)
	{
	struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);

	return !!__get_gpo_state_p3(group, pin);
	}

	static int lpc32xx_gpio_request(struct gpio_chip *chip, unsigned pin)
	{
	if (pin < chip->ngpio)
	return 0;

	return -EINVAL;
	}

	static int lpc32xx_gpio_to_irq_p01(struct gpio_chip *chip, unsigned offset)
	{
	return -ENXIO;
	}

	static int lpc32xx_gpio_to_irq_gpio_p3(struct gpio_chip *chip, unsigned offset)
	{
	return -ENXIO;
	}

	static int lpc32xx_gpio_to_irq_gpi_p3(struct gpio_chip *chip, unsigned offset)
	{
	return -ENXIO;
	}

	static struct lpc32xx_gpio_chip lpc32xx_gpiochip[] = {
	{
	.chip = {
	.label = "gpio_p0",
	.direction_input = lpc32xx_gpio_dir_input_p012,
	.get = lpc32xx_gpio_get_value_p012,
	.direction_output = lpc32xx_gpio_dir_output_p012,
	.set = lpc32xx_gpio_set_value_p012,
	.request = lpc32xx_gpio_request,
	.to_irq = lpc32xx_gpio_to_irq_p01,
	.base = LPC32XX_GPIO_P0_GRP,
	.ngpio = LPC32XX_GPIO_P0_MAX,
	.names = gpio_p0_names,
	.can_sleep = false,
	},
	.gpio_grp = &gpio_grp_regs_p0,
	},
	{
	.chip = {
	.label = "gpio_p1",
	.direction_input = lpc32xx_gpio_dir_input_p012,
	.get = lpc32xx_gpio_get_value_p012,
	.direction_output = lpc32xx_gpio_dir_output_p012,
	.set = lpc32xx_gpio_set_value_p012,
	.request = lpc32xx_gpio_request,
	.to_irq = lpc32xx_gpio_to_irq_p01,
	.base = LPC32XX_GPIO_P1_GRP,
	.ngpio = LPC32XX_GPIO_P1_MAX,
	.names = gpio_p1_names,
	.can_sleep = false,
	},
	.gpio_grp = &gpio_grp_regs_p1,
	},
	{
	.chip = {
	.label = "gpio_p2",
	.direction_input = lpc32xx_gpio_dir_input_p012,
	.get = lpc32xx_gpio_get_value_p012,
	.direction_output = lpc32xx_gpio_dir_output_p012,
	.set = lpc32xx_gpio_set_value_p012,
	.request = lpc32xx_gpio_request,
	.base = LPC32XX_GPIO_P2_GRP,
	.ngpio = LPC32XX_GPIO_P2_MAX,
	.names = gpio_p2_names,
	.can_sleep = false,
	},
	.gpio_grp = &gpio_grp_regs_p2,
	},
	{
	.chip = {
	.label = "gpio_p3",
	.direction_input = lpc32xx_gpio_dir_input_p3,
	.get = lpc32xx_gpio_get_value_p3,
	.direction_output = lpc32xx_gpio_dir_output_p3,
	.set = lpc32xx_gpio_set_value_p3,
	.request = lpc32xx_gpio_request,
	.to_irq = lpc32xx_gpio_to_irq_gpio_p3,
	.base = LPC32XX_GPIO_P3_GRP,
	.ngpio = LPC32XX_GPIO_P3_MAX,
	.names = gpio_p3_names,
	.can_sleep = false,
	},
	.gpio_grp = &gpio_grp_regs_p3,
	},
	{
	.chip = {
	.label = "gpi_p3",
	.direction_input = lpc32xx_gpio_dir_in_always,
	.get = lpc32xx_gpi_get_value,
	.request = lpc32xx_gpio_request,
	.to_irq = lpc32xx_gpio_to_irq_gpi_p3,
	.base = LPC32XX_GPI_P3_GRP,
	.ngpio = LPC32XX_GPI_P3_MAX,
	.names = gpi_p3_names,
	.can_sleep = false,
	},
	.gpio_grp = &gpio_grp_regs_p3,
	},
	{
	.chip = {
	.label = "gpo_p3",
	.direction_output = lpc32xx_gpio_dir_out_always,
	.set = lpc32xx_gpo_set_value,
	.get = lpc32xx_gpo_get_value,
	.request = lpc32xx_gpio_request,
	.base = LPC32XX_GPO_P3_GRP,
	.ngpio = LPC32XX_GPO_P3_MAX,
	.names = gpo_p3_names,
	.can_sleep = false,
	},
	.gpio_grp = &gpio_grp_regs_p3,
	},
	};

	static int lpc32xx_of_xlate(struct gpio_chip *gc,
	const struct of_phandle_args gpiospec, u32 flags)
	{
	/* Is this the correct bank? */
	u32 bank = gpiospec->args[0];
	if ((bank >= ARRAY_SIZE(lpc32xx_gpiochip) \|\|
	(gc != &lpc32xx_gpiochip[bank].chip)))
	return -EINVAL;

	if (flags)
	*flags = gpiospec->args[2];
	return gpiospec->args[1];
	}

	static int lpc32xx_gpio_probe(struct platform_device *pdev)
	{
	int i;

	for (i = 0; i < ARRAY_SIZE(lpc32xx_gpiochip); i++) {
	if (pdev->dev.of_node) {
	lpc32xx_gpiochip[i].chip.of_xlate = lpc32xx_of_xlate;
	lpc32xx_gpiochip[i].chip.of_gpio_n_cells = 3;
	lpc32xx_gpiochip[i].chip.of_node = pdev->dev.of_node;
	}
	devm_gpiochip_add_data(&pdev->dev, &lpc32xx_gpiochip[i].chip,
	&lpc32xx_gpiochip[i]);
	}

	return 0;
	}

	#ifdef CONFIG_OF
	static const struct of_device_id lpc32xx_gpio_of_match[] = {
	{ .compatible = "nxp,lpc3220-gpio", },
	{ },
	};
	#endif

	static struct platform_driver lpc32xx_gpio_driver = {
	.driver = {
	.name = "lpc32xx-gpio",
	.of_match_table = of_match_ptr(lpc32xx_gpio_of_match),
	},
	.probe = lpc32xx_gpio_probe,
	};

	module_platform_driver(lpc32xx_gpio_driver);