forked from mirrors/linux
		
	gpio: generic: factor into gpio_chip struct
The separate struct bgpio_chip has been a pain to handle, both by being confusingly similar in name to struct gpio_chip and for being contained inside a struct so that struct gpio_chip is contained in a struct contained in a struct, making several steps of dereferencing necessary. Make things simpler: include the fields directly into <linux/gpio/driver.h>, #ifdef:ed for CONFIG_GENERIC_GPIO, and get rid of the <linux/basic_mmio_gpio.h> altogether. Prefix some of the member variables with bgpio_* and add proper kerneldoc while we're at it. Modify all users to handle the change and use a struct gpio_chip directly. And while we're at it: replace all container_of() dereferencing by gpiochip_get_data() and registering the gpio_chip with gpiochip_add_data(). Cc: arm@kernel.org Cc: Alexander Shiyan <shc_work@mail.ru> Cc: Shawn Guo <shawnguo@kernel.org> Cc: Sascha Hauer <kernel@pengutronix.de> Cc: Kukjin Kim <kgene@kernel.org> Cc: Alexandre Courbot <gnurou@gmail.com> Cc: Brian Norris <computersforpeace@gmail.com> Cc: Florian Fainelli <f.fainelli@gmail.com> Cc: Sudeep Holla <sudeep.holla@arm.com> Cc: Lorenzo Pieralisi <lorenzo.pieralisi@arm.com> Cc: Nicolas Pitre <nicolas.pitre@linaro.org> Cc: Olof Johansson <olof@lixom.net> Cc: Vladimir Zapolskiy <vladimir_zapolskiy@mentor.com> Cc: Rabin Vincent <rabin@rab.in> Cc: linux-arm-kernel@lists.infradead.org Cc: linux-omap@vger.kernel.org Cc: linux-samsung-soc@vger.kernel.org Cc: bcm-kernel-feedback-list@broadcom.com Acked-by: Gregory Fong <gregory.0xf0@gmail.com> Acked-by: Liviu Dudau <Liviu.Dudau@arm.com> Acked-by: H Hartley Sweeten <hsweeten@visionengravers.com> Acked-by: Tony Lindgren <tony@atomide.com> Acked-by: Krzysztof Kozlowski <k.kozlowski@samsung.com> Acked-by: Lee Jones <lee.jones@linaro.org> Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
This commit is contained in:
		
							parent
							
								
									3208b0f0c0
								
							
						
					
					
						commit
						0f4630f372
					
				
					 22 changed files with 442 additions and 552 deletions
				
			
		| 
						 | 
				
			
			@ -31,7 +31,7 @@
 | 
			
		|||
#include <linux/mtd/partitions.h>
 | 
			
		||||
#include <linux/mtd/nand-gpio.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
 | 
			
		||||
#include <mach/hardware.h>
 | 
			
		||||
#include <asm/sizes.h>
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -28,7 +28,7 @@
 | 
			
		|||
#include <linux/leds.h>
 | 
			
		||||
#include <linux/sizes.h>
 | 
			
		||||
#include <linux/backlight.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
#include <linux/mtd/partitions.h>
 | 
			
		||||
#include <linux/mtd/nand-gpio.h>
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -17,7 +17,7 @@
 | 
			
		|||
#include <linux/platform_device.h>
 | 
			
		||||
#include <linux/mtd/mtd.h>
 | 
			
		||||
#include <linux/mtd/physmap.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/regulator/fixed.h>
 | 
			
		||||
#include <linux/regulator/machine.h>
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -11,7 +11,7 @@
 | 
			
		|||
 * it under the terms of the GNU General Public License version 2 as
 | 
			
		||||
 * published by the Free Software Foundation.
 | 
			
		||||
 */
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/kernel.h>
 | 
			
		||||
#include <linux/init.h>
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -29,7 +29,7 @@
 | 
			
		|||
#include <linux/pwm_backlight.h>
 | 
			
		||||
#include <linux/dm9000.h>
 | 
			
		||||
#include <linux/gpio_keys.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
#include <linux/spi/spi.h>
 | 
			
		||||
 | 
			
		||||
#include <linux/platform_data/pca953x.h>
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -10,10 +10,9 @@
 | 
			
		|||
 */
 | 
			
		||||
 | 
			
		||||
#include <linux/err.h>
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/module.h>
 | 
			
		||||
#include <linux/of_device.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
 | 
			
		||||
#define MMIO_74XX_DIR_IN	(0 << 8)
 | 
			
		||||
| 
						 | 
				
			
			@ -21,7 +20,7 @@
 | 
			
		|||
#define MMIO_74XX_BIT_CNT(x)	((x) & 0xff)
 | 
			
		||||
 | 
			
		||||
struct mmio_74xx_gpio_priv {
 | 
			
		||||
	struct bgpio_chip	bgc;
 | 
			
		||||
	struct gpio_chip	gc;
 | 
			
		||||
	unsigned		flags;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -78,30 +77,23 @@ static const struct of_device_id mmio_74xx_gpio_ids[] = {
 | 
			
		|||
};
 | 
			
		||||
MODULE_DEVICE_TABLE(of, mmio_74xx_gpio_ids);
 | 
			
		||||
 | 
			
		||||
static inline struct mmio_74xx_gpio_priv *to_74xx_gpio(struct gpio_chip *gc)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
 | 
			
		||||
	return container_of(bgc, struct mmio_74xx_gpio_priv, bgc);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int mmio_74xx_get_direction(struct gpio_chip *gc, unsigned offset)
 | 
			
		||||
{
 | 
			
		||||
	struct mmio_74xx_gpio_priv *priv = to_74xx_gpio(gc);
 | 
			
		||||
	struct mmio_74xx_gpio_priv *priv = gpiochip_get_data(gc);
 | 
			
		||||
 | 
			
		||||
	return (priv->flags & MMIO_74XX_DIR_OUT) ? GPIOF_DIR_OUT : GPIOF_DIR_IN;
 | 
			
		||||
	return !(priv->flags & MMIO_74XX_DIR_OUT);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int mmio_74xx_dir_in(struct gpio_chip *gc, unsigned int gpio)
 | 
			
		||||
{
 | 
			
		||||
	struct mmio_74xx_gpio_priv *priv = to_74xx_gpio(gc);
 | 
			
		||||
	struct mmio_74xx_gpio_priv *priv = gpiochip_get_data(gc);
 | 
			
		||||
 | 
			
		||||
	return (priv->flags & MMIO_74XX_DIR_OUT) ? -ENOTSUPP : 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int mmio_74xx_dir_out(struct gpio_chip *gc, unsigned int gpio, int val)
 | 
			
		||||
{
 | 
			
		||||
	struct mmio_74xx_gpio_priv *priv = to_74xx_gpio(gc);
 | 
			
		||||
	struct mmio_74xx_gpio_priv *priv = gpiochip_get_data(gc);
 | 
			
		||||
 | 
			
		||||
	if (priv->flags & MMIO_74XX_DIR_OUT) {
 | 
			
		||||
		gc->set(gc, gpio, val);
 | 
			
		||||
| 
						 | 
				
			
			@ -134,28 +126,29 @@ static int mmio_74xx_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
 | 
			
		||||
	priv->flags = (uintptr_t) of_id->data;
 | 
			
		||||
 | 
			
		||||
	err = bgpio_init(&priv->bgc, &pdev->dev,
 | 
			
		||||
	err = bgpio_init(&priv->gc, &pdev->dev,
 | 
			
		||||
			 DIV_ROUND_UP(MMIO_74XX_BIT_CNT(priv->flags), 8),
 | 
			
		||||
			 dat, NULL, NULL, NULL, NULL, 0);
 | 
			
		||||
	if (err)
 | 
			
		||||
		return err;
 | 
			
		||||
 | 
			
		||||
	priv->bgc.gc.direction_input = mmio_74xx_dir_in;
 | 
			
		||||
	priv->bgc.gc.direction_output = mmio_74xx_dir_out;
 | 
			
		||||
	priv->bgc.gc.get_direction = mmio_74xx_get_direction;
 | 
			
		||||
	priv->bgc.gc.ngpio = MMIO_74XX_BIT_CNT(priv->flags);
 | 
			
		||||
	priv->bgc.gc.owner = THIS_MODULE;
 | 
			
		||||
	priv->gc.direction_input = mmio_74xx_dir_in;
 | 
			
		||||
	priv->gc.direction_output = mmio_74xx_dir_out;
 | 
			
		||||
	priv->gc.get_direction = mmio_74xx_get_direction;
 | 
			
		||||
	priv->gc.ngpio = MMIO_74XX_BIT_CNT(priv->flags);
 | 
			
		||||
	priv->gc.owner = THIS_MODULE;
 | 
			
		||||
 | 
			
		||||
	platform_set_drvdata(pdev, priv);
 | 
			
		||||
 | 
			
		||||
	return gpiochip_add(&priv->bgc.gc);
 | 
			
		||||
	return gpiochip_add_data(&priv->gc, priv);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int mmio_74xx_gpio_remove(struct platform_device *pdev)
 | 
			
		||||
{
 | 
			
		||||
	struct mmio_74xx_gpio_priv *priv = platform_get_drvdata(pdev);
 | 
			
		||||
 | 
			
		||||
	return bgpio_remove(&priv->bgc);
 | 
			
		||||
	gpiochip_remove(&priv->gc);
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static struct platform_driver mmio_74xx_gpio_driver = {
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -16,7 +16,6 @@
 | 
			
		|||
#include <linux/of_device.h>
 | 
			
		||||
#include <linux/of_irq.h>
 | 
			
		||||
#include <linux/module.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/irqdomain.h>
 | 
			
		||||
#include <linux/irqchip/chained_irq.h>
 | 
			
		||||
#include <linux/interrupt.h>
 | 
			
		||||
| 
						 | 
				
			
			@ -35,7 +34,7 @@
 | 
			
		|||
struct brcmstb_gpio_bank {
 | 
			
		||||
	struct list_head node;
 | 
			
		||||
	int id;
 | 
			
		||||
	struct bgpio_chip bgc;
 | 
			
		||||
	struct gpio_chip gc;
 | 
			
		||||
	struct brcmstb_gpio_priv *parent_priv;
 | 
			
		||||
	u32 width;
 | 
			
		||||
	struct irq_chip irq_chip;
 | 
			
		||||
| 
						 | 
				
			
			@ -57,37 +56,30 @@ struct brcmstb_gpio_priv {
 | 
			
		|||
/* assumes MAX_GPIO_PER_BANK is a multiple of 2 */
 | 
			
		||||
#define GPIO_BIT(gpio)          ((gpio) & (MAX_GPIO_PER_BANK - 1))
 | 
			
		||||
 | 
			
		||||
static inline struct brcmstb_gpio_bank *
 | 
			
		||||
brcmstb_gpio_gc_to_bank(struct gpio_chip *gc)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	return container_of(bgc, struct brcmstb_gpio_bank, bgc);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static inline struct brcmstb_gpio_priv *
 | 
			
		||||
brcmstb_gpio_gc_to_priv(struct gpio_chip *gc)
 | 
			
		||||
{
 | 
			
		||||
	struct brcmstb_gpio_bank *bank = brcmstb_gpio_gc_to_bank(gc);
 | 
			
		||||
	struct brcmstb_gpio_bank *bank = gpiochip_get_data(gc);
 | 
			
		||||
	return bank->parent_priv;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void brcmstb_gpio_set_imask(struct brcmstb_gpio_bank *bank,
 | 
			
		||||
		unsigned int offset, bool enable)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = &bank->bgc;
 | 
			
		||||
	struct gpio_chip *gc = &bank->gc;
 | 
			
		||||
	struct brcmstb_gpio_priv *priv = bank->parent_priv;
 | 
			
		||||
	u32 mask = bgc->pin2mask(bgc, offset);
 | 
			
		||||
	u32 mask = gc->pin2mask(gc, offset);
 | 
			
		||||
	u32 imask;
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	imask = bgc->read_reg(priv->reg_base + GIO_MASK(bank->id));
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
	imask = gc->read_reg(priv->reg_base + GIO_MASK(bank->id));
 | 
			
		||||
	if (enable)
 | 
			
		||||
		imask |= mask;
 | 
			
		||||
	else
 | 
			
		||||
		imask &= ~mask;
 | 
			
		||||
	bgc->write_reg(priv->reg_base + GIO_MASK(bank->id), imask);
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	gc->write_reg(priv->reg_base + GIO_MASK(bank->id), imask);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* -------------------- IRQ chip functions -------------------- */
 | 
			
		||||
| 
						 | 
				
			
			@ -95,7 +87,7 @@ static void brcmstb_gpio_set_imask(struct brcmstb_gpio_bank *bank,
 | 
			
		|||
static void brcmstb_gpio_irq_mask(struct irq_data *d)
 | 
			
		||||
{
 | 
			
		||||
	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
 | 
			
		||||
	struct brcmstb_gpio_bank *bank = brcmstb_gpio_gc_to_bank(gc);
 | 
			
		||||
	struct brcmstb_gpio_bank *bank = gpiochip_get_data(gc);
 | 
			
		||||
 | 
			
		||||
	brcmstb_gpio_set_imask(bank, d->hwirq, false);
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			@ -103,7 +95,7 @@ static void brcmstb_gpio_irq_mask(struct irq_data *d)
 | 
			
		|||
static void brcmstb_gpio_irq_unmask(struct irq_data *d)
 | 
			
		||||
{
 | 
			
		||||
	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
 | 
			
		||||
	struct brcmstb_gpio_bank *bank = brcmstb_gpio_gc_to_bank(gc);
 | 
			
		||||
	struct brcmstb_gpio_bank *bank = gpiochip_get_data(gc);
 | 
			
		||||
 | 
			
		||||
	brcmstb_gpio_set_imask(bank, d->hwirq, true);
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			@ -111,7 +103,7 @@ static void brcmstb_gpio_irq_unmask(struct irq_data *d)
 | 
			
		|||
static int brcmstb_gpio_irq_set_type(struct irq_data *d, unsigned int type)
 | 
			
		||||
{
 | 
			
		||||
	struct gpio_chip *gc = irq_data_get_irq_chip_data(d);
 | 
			
		||||
	struct brcmstb_gpio_bank *bank = brcmstb_gpio_gc_to_bank(gc);
 | 
			
		||||
	struct brcmstb_gpio_bank *bank = gpiochip_get_data(gc);
 | 
			
		||||
	struct brcmstb_gpio_priv *priv = bank->parent_priv;
 | 
			
		||||
	u32 mask = BIT(d->hwirq);
 | 
			
		||||
	u32 edge_insensitive, iedge_insensitive;
 | 
			
		||||
| 
						 | 
				
			
			@ -149,23 +141,23 @@ static int brcmstb_gpio_irq_set_type(struct irq_data *d, unsigned int type)
 | 
			
		|||
		return -EINVAL;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bank->bgc.lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&bank->gc.bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	iedge_config = bank->bgc.read_reg(priv->reg_base +
 | 
			
		||||
	iedge_config = bank->gc.read_reg(priv->reg_base +
 | 
			
		||||
			GIO_EC(bank->id)) & ~mask;
 | 
			
		||||
	iedge_insensitive = bank->bgc.read_reg(priv->reg_base +
 | 
			
		||||
	iedge_insensitive = bank->gc.read_reg(priv->reg_base +
 | 
			
		||||
			GIO_EI(bank->id)) & ~mask;
 | 
			
		||||
	ilevel = bank->bgc.read_reg(priv->reg_base +
 | 
			
		||||
	ilevel = bank->gc.read_reg(priv->reg_base +
 | 
			
		||||
			GIO_LEVEL(bank->id)) & ~mask;
 | 
			
		||||
 | 
			
		||||
	bank->bgc.write_reg(priv->reg_base + GIO_EC(bank->id),
 | 
			
		||||
	bank->gc.write_reg(priv->reg_base + GIO_EC(bank->id),
 | 
			
		||||
			iedge_config | edge_config);
 | 
			
		||||
	bank->bgc.write_reg(priv->reg_base + GIO_EI(bank->id),
 | 
			
		||||
	bank->gc.write_reg(priv->reg_base + GIO_EI(bank->id),
 | 
			
		||||
			iedge_insensitive | edge_insensitive);
 | 
			
		||||
	bank->bgc.write_reg(priv->reg_base + GIO_LEVEL(bank->id),
 | 
			
		||||
	bank->gc.write_reg(priv->reg_base + GIO_LEVEL(bank->id),
 | 
			
		||||
			ilevel | level);
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&bank->bgc.lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&bank->gc.bgpio_lock, flags);
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -210,29 +202,29 @@ static irqreturn_t brcmstb_gpio_wake_irq_handler(int irq, void *data)
 | 
			
		|||
static void brcmstb_gpio_irq_bank_handler(struct brcmstb_gpio_bank *bank)
 | 
			
		||||
{
 | 
			
		||||
	struct brcmstb_gpio_priv *priv = bank->parent_priv;
 | 
			
		||||
	struct irq_domain *irq_domain = bank->bgc.gc.irqdomain;
 | 
			
		||||
	struct irq_domain *irq_domain = bank->gc.irqdomain;
 | 
			
		||||
	void __iomem *reg_base = priv->reg_base;
 | 
			
		||||
	unsigned long status;
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bank->bgc.lock, flags);
 | 
			
		||||
	while ((status = bank->bgc.read_reg(reg_base + GIO_STAT(bank->id)) &
 | 
			
		||||
			 bank->bgc.read_reg(reg_base + GIO_MASK(bank->id)))) {
 | 
			
		||||
	spin_lock_irqsave(&bank->gc.bgpio_lock, flags);
 | 
			
		||||
	while ((status = bank->gc.read_reg(reg_base + GIO_STAT(bank->id)) &
 | 
			
		||||
			 bank->gc.read_reg(reg_base + GIO_MASK(bank->id)))) {
 | 
			
		||||
		int bit;
 | 
			
		||||
 | 
			
		||||
		for_each_set_bit(bit, &status, 32) {
 | 
			
		||||
			u32 stat = bank->bgc.read_reg(reg_base +
 | 
			
		||||
			u32 stat = bank->gc.read_reg(reg_base +
 | 
			
		||||
						      GIO_STAT(bank->id));
 | 
			
		||||
			if (bit >= bank->width)
 | 
			
		||||
				dev_warn(&priv->pdev->dev,
 | 
			
		||||
					 "IRQ for invalid GPIO (bank=%d, offset=%d)\n",
 | 
			
		||||
					 bank->id, bit);
 | 
			
		||||
			bank->bgc.write_reg(reg_base + GIO_STAT(bank->id),
 | 
			
		||||
			bank->gc.write_reg(reg_base + GIO_STAT(bank->id),
 | 
			
		||||
					    stat | BIT(bit));
 | 
			
		||||
			generic_handle_irq(irq_find_mapping(irq_domain, bit));
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
	spin_unlock_irqrestore(&bank->bgc.lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&bank->gc.bgpio_lock, flags);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Each UPG GIO block has one IRQ for all banks */
 | 
			
		||||
| 
						 | 
				
			
			@ -303,9 +295,7 @@ static int brcmstb_gpio_remove(struct platform_device *pdev)
 | 
			
		|||
	 */
 | 
			
		||||
	list_for_each(pos, &priv->bank_list) {
 | 
			
		||||
		bank = list_entry(pos, struct brcmstb_gpio_bank, node);
 | 
			
		||||
		ret = bgpio_remove(&bank->bgc);
 | 
			
		||||
		if (ret)
 | 
			
		||||
			dev_err(&pdev->dev, "gpiochip_remove fail in cleanup\n");
 | 
			
		||||
		gpiochip_remove(&bank->gc);
 | 
			
		||||
	}
 | 
			
		||||
	if (priv->reboot_notifier.notifier_call) {
 | 
			
		||||
		ret = unregister_reboot_notifier(&priv->reboot_notifier);
 | 
			
		||||
| 
						 | 
				
			
			@ -320,7 +310,7 @@ static int brcmstb_gpio_of_xlate(struct gpio_chip *gc,
 | 
			
		|||
		const struct of_phandle_args *gpiospec, u32 *flags)
 | 
			
		||||
{
 | 
			
		||||
	struct brcmstb_gpio_priv *priv = brcmstb_gpio_gc_to_priv(gc);
 | 
			
		||||
	struct brcmstb_gpio_bank *bank = brcmstb_gpio_gc_to_bank(gc);
 | 
			
		||||
	struct brcmstb_gpio_bank *bank = gpiochip_get_data(gc);
 | 
			
		||||
	int offset;
 | 
			
		||||
 | 
			
		||||
	if (gc->of_gpio_n_cells != 2) {
 | 
			
		||||
| 
						 | 
				
			
			@ -398,9 +388,9 @@ static int brcmstb_gpio_irq_setup(struct platform_device *pdev,
 | 
			
		|||
	if (priv->can_wake)
 | 
			
		||||
		bank->irq_chip.irq_set_wake = brcmstb_gpio_irq_set_wake;
 | 
			
		||||
 | 
			
		||||
	gpiochip_irqchip_add(&bank->bgc.gc, &bank->irq_chip, 0,
 | 
			
		||||
	gpiochip_irqchip_add(&bank->gc, &bank->irq_chip, 0,
 | 
			
		||||
			handle_simple_irq, IRQ_TYPE_NONE);
 | 
			
		||||
	gpiochip_set_chained_irqchip(&bank->bgc.gc, &bank->irq_chip,
 | 
			
		||||
	gpiochip_set_chained_irqchip(&bank->gc, &bank->irq_chip,
 | 
			
		||||
			priv->parent_irq, brcmstb_gpio_irq_handler);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
| 
						 | 
				
			
			@ -451,7 +441,6 @@ static int brcmstb_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
	of_property_for_each_u32(np, "brcm,gpio-bank-widths", prop, p,
 | 
			
		||||
			bank_width) {
 | 
			
		||||
		struct brcmstb_gpio_bank *bank;
 | 
			
		||||
		struct bgpio_chip *bgc;
 | 
			
		||||
		struct gpio_chip *gc;
 | 
			
		||||
 | 
			
		||||
		bank = devm_kzalloc(dev, sizeof(*bank), GFP_KERNEL);
 | 
			
		||||
| 
						 | 
				
			
			@ -473,8 +462,8 @@ static int brcmstb_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
		 * Regs are 4 bytes wide, have data reg, no set/clear regs,
 | 
			
		||||
		 * and direction bits have 0 = output and 1 = input
 | 
			
		||||
		 */
 | 
			
		||||
		bgc = &bank->bgc;
 | 
			
		||||
		err = bgpio_init(bgc, dev, 4,
 | 
			
		||||
		gc = &bank->gc;
 | 
			
		||||
		err = bgpio_init(gc, dev, 4,
 | 
			
		||||
				reg_base + GIO_DATA(bank->id),
 | 
			
		||||
				NULL, NULL, NULL,
 | 
			
		||||
				reg_base + GIO_IODIR(bank->id), 0);
 | 
			
		||||
| 
						 | 
				
			
			@ -483,7 +472,6 @@ static int brcmstb_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
			goto fail;
 | 
			
		||||
		}
 | 
			
		||||
 | 
			
		||||
		gc = &bgc->gc;
 | 
			
		||||
		gc->of_node = np;
 | 
			
		||||
		gc->owner = THIS_MODULE;
 | 
			
		||||
		gc->label = np->full_name;
 | 
			
		||||
| 
						 | 
				
			
			@ -497,9 +485,9 @@ static int brcmstb_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
		 * Mask all interrupts by default, since wakeup interrupts may
 | 
			
		||||
		 * be retained from S5 cold boot
 | 
			
		||||
		 */
 | 
			
		||||
		bank->bgc.write_reg(reg_base + GIO_MASK(bank->id), 0);
 | 
			
		||||
		gc->write_reg(reg_base + GIO_MASK(bank->id), 0);
 | 
			
		||||
 | 
			
		||||
		err = gpiochip_add(gc);
 | 
			
		||||
		err = gpiochip_add_data(gc, bank);
 | 
			
		||||
		if (err) {
 | 
			
		||||
			dev_err(dev, "Could not add gpiochip for bank %d\n",
 | 
			
		||||
					bank->id);
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -10,24 +10,23 @@
 | 
			
		|||
 */
 | 
			
		||||
 | 
			
		||||
#include <linux/err.h>
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/module.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
 | 
			
		||||
static int clps711x_gpio_probe(struct platform_device *pdev)
 | 
			
		||||
{
 | 
			
		||||
	struct device_node *np = pdev->dev.of_node;
 | 
			
		||||
	void __iomem *dat, *dir;
 | 
			
		||||
	struct bgpio_chip *bgc;
 | 
			
		||||
	struct gpio_chip *gc;
 | 
			
		||||
	struct resource *res;
 | 
			
		||||
	int err, id = np ? of_alias_get_id(np, "gpio") : pdev->id;
 | 
			
		||||
 | 
			
		||||
	if ((id < 0) || (id > 4))
 | 
			
		||||
		return -ENODEV;
 | 
			
		||||
 | 
			
		||||
	bgc = devm_kzalloc(&pdev->dev, sizeof(*bgc), GFP_KERNEL);
 | 
			
		||||
	if (!bgc)
 | 
			
		||||
	gc = devm_kzalloc(&pdev->dev, sizeof(*gc), GFP_KERNEL);
 | 
			
		||||
	if (!gc)
 | 
			
		||||
		return -ENOMEM;
 | 
			
		||||
 | 
			
		||||
	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 | 
			
		||||
| 
						 | 
				
			
			@ -43,11 +42,11 @@ static int clps711x_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
	switch (id) {
 | 
			
		||||
	case 3:
 | 
			
		||||
		/* PORTD is inverted logic for direction register */
 | 
			
		||||
		err = bgpio_init(bgc, &pdev->dev, 1, dat, NULL, NULL,
 | 
			
		||||
		err = bgpio_init(gc, &pdev->dev, 1, dat, NULL, NULL,
 | 
			
		||||
				 NULL, dir, 0);
 | 
			
		||||
		break;
 | 
			
		||||
	default:
 | 
			
		||||
		err = bgpio_init(bgc, &pdev->dev, 1, dat, NULL, NULL,
 | 
			
		||||
		err = bgpio_init(gc, &pdev->dev, 1, dat, NULL, NULL,
 | 
			
		||||
				 dir, NULL, 0);
 | 
			
		||||
		break;
 | 
			
		||||
	}
 | 
			
		||||
| 
						 | 
				
			
			@ -58,24 +57,25 @@ static int clps711x_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
	switch (id) {
 | 
			
		||||
	case 4:
 | 
			
		||||
		/* PORTE is 3 lines only */
 | 
			
		||||
		bgc->gc.ngpio = 3;
 | 
			
		||||
		gc->ngpio = 3;
 | 
			
		||||
		break;
 | 
			
		||||
	default:
 | 
			
		||||
		break;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	bgc->gc.base = id * 8;
 | 
			
		||||
	bgc->gc.owner = THIS_MODULE;
 | 
			
		||||
	platform_set_drvdata(pdev, bgc);
 | 
			
		||||
	gc->base = id * 8;
 | 
			
		||||
	gc->owner = THIS_MODULE;
 | 
			
		||||
	platform_set_drvdata(pdev, gc);
 | 
			
		||||
 | 
			
		||||
	return gpiochip_add(&bgc->gc);
 | 
			
		||||
	return gpiochip_add_data(gc, NULL);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int clps711x_gpio_remove(struct platform_device *pdev)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = platform_get_drvdata(pdev);
 | 
			
		||||
	struct gpio_chip *gc = platform_get_drvdata(pdev);
 | 
			
		||||
 | 
			
		||||
	return bgpio_remove(bgc);
 | 
			
		||||
	gpiochip_remove(gc);
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static const struct of_device_id __maybe_unused clps711x_gpio_ids[] = {
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -7,7 +7,9 @@
 | 
			
		|||
 *
 | 
			
		||||
 * All enquiries to support@picochip.com
 | 
			
		||||
 */
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
/* FIXME: for gpio_get_value(), replace this with direct register read */
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/err.h>
 | 
			
		||||
#include <linux/init.h>
 | 
			
		||||
#include <linux/interrupt.h>
 | 
			
		||||
| 
						 | 
				
			
			@ -66,7 +68,7 @@ struct dwapb_context {
 | 
			
		|||
#endif
 | 
			
		||||
 | 
			
		||||
struct dwapb_gpio_port {
 | 
			
		||||
	struct bgpio_chip	bgc;
 | 
			
		||||
	struct gpio_chip	gc;
 | 
			
		||||
	bool			is_registered;
 | 
			
		||||
	struct dwapb_gpio	*gpio;
 | 
			
		||||
#ifdef CONFIG_PM_SLEEP
 | 
			
		||||
| 
						 | 
				
			
			@ -83,33 +85,26 @@ struct dwapb_gpio {
 | 
			
		|||
	struct irq_domain	*domain;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static inline struct dwapb_gpio_port *
 | 
			
		||||
to_dwapb_gpio_port(struct bgpio_chip *bgc)
 | 
			
		||||
{
 | 
			
		||||
	return container_of(bgc, struct dwapb_gpio_port, bgc);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static inline u32 dwapb_read(struct dwapb_gpio *gpio, unsigned int offset)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc	= &gpio->ports[0].bgc;
 | 
			
		||||
	struct gpio_chip *gc	= &gpio->ports[0].gc;
 | 
			
		||||
	void __iomem *reg_base	= gpio->regs;
 | 
			
		||||
 | 
			
		||||
	return bgc->read_reg(reg_base + offset);
 | 
			
		||||
	return gc->read_reg(reg_base + offset);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static inline void dwapb_write(struct dwapb_gpio *gpio, unsigned int offset,
 | 
			
		||||
			       u32 val)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc	= &gpio->ports[0].bgc;
 | 
			
		||||
	struct gpio_chip *gc	= &gpio->ports[0].gc;
 | 
			
		||||
	void __iomem *reg_base	= gpio->regs;
 | 
			
		||||
 | 
			
		||||
	bgc->write_reg(reg_base + offset, val);
 | 
			
		||||
	gc->write_reg(reg_base + offset, val);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int dwapb_gpio_to_irq(struct gpio_chip *gc, unsigned offset)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	struct dwapb_gpio_port *port = to_dwapb_gpio_port(bgc);
 | 
			
		||||
	struct dwapb_gpio_port *port = gpiochip_get_data(gc);
 | 
			
		||||
	struct dwapb_gpio *gpio = port->gpio;
 | 
			
		||||
 | 
			
		||||
	return irq_find_mapping(gpio->domain, offset);
 | 
			
		||||
| 
						 | 
				
			
			@ -119,7 +114,7 @@ static void dwapb_toggle_trigger(struct dwapb_gpio *gpio, unsigned int offs)
 | 
			
		|||
{
 | 
			
		||||
	u32 v = dwapb_read(gpio, GPIO_INT_POLARITY);
 | 
			
		||||
 | 
			
		||||
	if (gpio_get_value(gpio->ports[0].bgc.gc.base + offs))
 | 
			
		||||
	if (gpio_get_value(gpio->ports[0].gc.base + offs))
 | 
			
		||||
		v &= ~BIT(offs);
 | 
			
		||||
	else
 | 
			
		||||
		v |= BIT(offs);
 | 
			
		||||
| 
						 | 
				
			
			@ -162,39 +157,39 @@ static void dwapb_irq_enable(struct irq_data *d)
 | 
			
		|||
{
 | 
			
		||||
	struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
 | 
			
		||||
	struct dwapb_gpio *gpio = igc->private;
 | 
			
		||||
	struct bgpio_chip *bgc = &gpio->ports[0].bgc;
 | 
			
		||||
	struct gpio_chip *gc = &gpio->ports[0].gc;
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
	u32 val;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
	val = dwapb_read(gpio, GPIO_INTEN);
 | 
			
		||||
	val |= BIT(d->hwirq);
 | 
			
		||||
	dwapb_write(gpio, GPIO_INTEN, val);
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void dwapb_irq_disable(struct irq_data *d)
 | 
			
		||||
{
 | 
			
		||||
	struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
 | 
			
		||||
	struct dwapb_gpio *gpio = igc->private;
 | 
			
		||||
	struct bgpio_chip *bgc = &gpio->ports[0].bgc;
 | 
			
		||||
	struct gpio_chip *gc = &gpio->ports[0].gc;
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
	u32 val;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
	val = dwapb_read(gpio, GPIO_INTEN);
 | 
			
		||||
	val &= ~BIT(d->hwirq);
 | 
			
		||||
	dwapb_write(gpio, GPIO_INTEN, val);
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int dwapb_irq_reqres(struct irq_data *d)
 | 
			
		||||
{
 | 
			
		||||
	struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
 | 
			
		||||
	struct dwapb_gpio *gpio = igc->private;
 | 
			
		||||
	struct bgpio_chip *bgc = &gpio->ports[0].bgc;
 | 
			
		||||
	struct gpio_chip *gc = &gpio->ports[0].gc;
 | 
			
		||||
 | 
			
		||||
	if (gpiochip_lock_as_irq(&bgc->gc, irqd_to_hwirq(d))) {
 | 
			
		||||
	if (gpiochip_lock_as_irq(gc, irqd_to_hwirq(d))) {
 | 
			
		||||
		dev_err(gpio->dev, "unable to lock HW IRQ %lu for IRQ\n",
 | 
			
		||||
			irqd_to_hwirq(d));
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
| 
						 | 
				
			
			@ -206,16 +201,16 @@ static void dwapb_irq_relres(struct irq_data *d)
 | 
			
		|||
{
 | 
			
		||||
	struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
 | 
			
		||||
	struct dwapb_gpio *gpio = igc->private;
 | 
			
		||||
	struct bgpio_chip *bgc = &gpio->ports[0].bgc;
 | 
			
		||||
	struct gpio_chip *gc = &gpio->ports[0].gc;
 | 
			
		||||
 | 
			
		||||
	gpiochip_unlock_as_irq(&bgc->gc, irqd_to_hwirq(d));
 | 
			
		||||
	gpiochip_unlock_as_irq(gc, irqd_to_hwirq(d));
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int dwapb_irq_set_type(struct irq_data *d, u32 type)
 | 
			
		||||
{
 | 
			
		||||
	struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
 | 
			
		||||
	struct dwapb_gpio *gpio = igc->private;
 | 
			
		||||
	struct bgpio_chip *bgc = &gpio->ports[0].bgc;
 | 
			
		||||
	struct gpio_chip *gc = &gpio->ports[0].gc;
 | 
			
		||||
	int bit = d->hwirq;
 | 
			
		||||
	unsigned long level, polarity, flags;
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -223,7 +218,7 @@ static int dwapb_irq_set_type(struct irq_data *d, u32 type)
 | 
			
		|||
		     IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW))
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
	level = dwapb_read(gpio, GPIO_INTTYPE_LEVEL);
 | 
			
		||||
	polarity = dwapb_read(gpio, GPIO_INT_POLARITY);
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -254,7 +249,7 @@ static int dwapb_irq_set_type(struct irq_data *d, u32 type)
 | 
			
		|||
 | 
			
		||||
	dwapb_write(gpio, GPIO_INTTYPE_LEVEL, level);
 | 
			
		||||
	dwapb_write(gpio, GPIO_INT_POLARITY, polarity);
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			@ -262,13 +257,12 @@ static int dwapb_irq_set_type(struct irq_data *d, u32 type)
 | 
			
		|||
static int dwapb_gpio_set_debounce(struct gpio_chip *gc,
 | 
			
		||||
				   unsigned offset, unsigned debounce)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	struct dwapb_gpio_port *port = to_dwapb_gpio_port(bgc);
 | 
			
		||||
	struct dwapb_gpio_port *port = gpiochip_get_data(gc);
 | 
			
		||||
	struct dwapb_gpio *gpio = port->gpio;
 | 
			
		||||
	unsigned long flags, val_deb;
 | 
			
		||||
	unsigned long mask = bgc->pin2mask(bgc, offset);
 | 
			
		||||
	unsigned long mask = gc->pin2mask(gc, offset);
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	val_deb = dwapb_read(gpio, GPIO_PORTA_DEBOUNCE);
 | 
			
		||||
	if (debounce)
 | 
			
		||||
| 
						 | 
				
			
			@ -276,7 +270,7 @@ static int dwapb_gpio_set_debounce(struct gpio_chip *gc,
 | 
			
		|||
	else
 | 
			
		||||
		dwapb_write(gpio, GPIO_PORTA_DEBOUNCE, val_deb & ~mask);
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			@ -295,7 +289,7 @@ static void dwapb_configure_irqs(struct dwapb_gpio *gpio,
 | 
			
		|||
				 struct dwapb_gpio_port *port,
 | 
			
		||||
				 struct dwapb_port_property *pp)
 | 
			
		||||
{
 | 
			
		||||
	struct gpio_chip *gc = &port->bgc.gc;
 | 
			
		||||
	struct gpio_chip *gc = &port->gc;
 | 
			
		||||
	struct device_node *node = pp->node;
 | 
			
		||||
	struct irq_chip_generic	*irq_gc = NULL;
 | 
			
		||||
	unsigned int hwirq, ngpio = gc->ngpio;
 | 
			
		||||
| 
						 | 
				
			
			@ -369,13 +363,13 @@ static void dwapb_configure_irqs(struct dwapb_gpio *gpio,
 | 
			
		|||
	for (hwirq = 0 ; hwirq < ngpio ; hwirq++)
 | 
			
		||||
		irq_create_mapping(gpio->domain, hwirq);
 | 
			
		||||
 | 
			
		||||
	port->bgc.gc.to_irq = dwapb_gpio_to_irq;
 | 
			
		||||
	port->gc.to_irq = dwapb_gpio_to_irq;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void dwapb_irq_teardown(struct dwapb_gpio *gpio)
 | 
			
		||||
{
 | 
			
		||||
	struct dwapb_gpio_port *port = &gpio->ports[0];
 | 
			
		||||
	struct gpio_chip *gc = &port->bgc.gc;
 | 
			
		||||
	struct gpio_chip *gc = &port->gc;
 | 
			
		||||
	unsigned int ngpio = gc->ngpio;
 | 
			
		||||
	irq_hw_number_t hwirq;
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -412,7 +406,7 @@ static int dwapb_gpio_add_port(struct dwapb_gpio *gpio,
 | 
			
		|||
	dirout = gpio->regs + GPIO_SWPORTA_DDR +
 | 
			
		||||
		(pp->idx * GPIO_SWPORT_DDR_SIZE);
 | 
			
		||||
 | 
			
		||||
	err = bgpio_init(&port->bgc, gpio->dev, 4, dat, set, NULL, dirout,
 | 
			
		||||
	err = bgpio_init(&port->gc, gpio->dev, 4, dat, set, NULL, dirout,
 | 
			
		||||
			 NULL, false);
 | 
			
		||||
	if (err) {
 | 
			
		||||
		dev_err(gpio->dev, "failed to init gpio chip for %s\n",
 | 
			
		||||
| 
						 | 
				
			
			@ -421,19 +415,19 @@ static int dwapb_gpio_add_port(struct dwapb_gpio *gpio,
 | 
			
		|||
	}
 | 
			
		||||
 | 
			
		||||
#ifdef CONFIG_OF_GPIO
 | 
			
		||||
	port->bgc.gc.of_node = pp->node;
 | 
			
		||||
	port->gc.of_node = pp->node;
 | 
			
		||||
#endif
 | 
			
		||||
	port->bgc.gc.ngpio = pp->ngpio;
 | 
			
		||||
	port->bgc.gc.base = pp->gpio_base;
 | 
			
		||||
	port->gc.ngpio = pp->ngpio;
 | 
			
		||||
	port->gc.base = pp->gpio_base;
 | 
			
		||||
 | 
			
		||||
	/* Only port A support debounce */
 | 
			
		||||
	if (pp->idx == 0)
 | 
			
		||||
		port->bgc.gc.set_debounce = dwapb_gpio_set_debounce;
 | 
			
		||||
		port->gc.set_debounce = dwapb_gpio_set_debounce;
 | 
			
		||||
 | 
			
		||||
	if (pp->irq)
 | 
			
		||||
		dwapb_configure_irqs(gpio, port, pp);
 | 
			
		||||
 | 
			
		||||
	err = gpiochip_add(&port->bgc.gc);
 | 
			
		||||
	err = gpiochip_add_data(&port->gc, port);
 | 
			
		||||
	if (err)
 | 
			
		||||
		dev_err(gpio->dev, "failed to register gpiochip for %s\n",
 | 
			
		||||
			pp->name);
 | 
			
		||||
| 
						 | 
				
			
			@ -449,7 +443,7 @@ static void dwapb_gpio_unregister(struct dwapb_gpio *gpio)
 | 
			
		|||
 | 
			
		||||
	for (m = 0; m < gpio->nr_ports; ++m)
 | 
			
		||||
		if (gpio->ports[m].is_registered)
 | 
			
		||||
			gpiochip_remove(&gpio->ports[m].bgc.gc);
 | 
			
		||||
			gpiochip_remove(&gpio->ports[m].gc);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static struct dwapb_platform_data *
 | 
			
		||||
| 
						 | 
				
			
			@ -591,11 +585,11 @@ static int dwapb_gpio_suspend(struct device *dev)
 | 
			
		|||
{
 | 
			
		||||
	struct platform_device *pdev = to_platform_device(dev);
 | 
			
		||||
	struct dwapb_gpio *gpio = platform_get_drvdata(pdev);
 | 
			
		||||
	struct bgpio_chip *bgc	= &gpio->ports[0].bgc;
 | 
			
		||||
	struct gpio_chip *gc	= &gpio->ports[0].gc;
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
	int i;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
	for (i = 0; i < gpio->nr_ports; i++) {
 | 
			
		||||
		unsigned int offset;
 | 
			
		||||
		unsigned int idx = gpio->ports[i].idx;
 | 
			
		||||
| 
						 | 
				
			
			@ -624,7 +618,7 @@ static int dwapb_gpio_suspend(struct device *dev)
 | 
			
		|||
			dwapb_write(gpio, GPIO_INTMASK, 0xffffffff);
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			@ -633,11 +627,11 @@ static int dwapb_gpio_resume(struct device *dev)
 | 
			
		|||
{
 | 
			
		||||
	struct platform_device *pdev = to_platform_device(dev);
 | 
			
		||||
	struct dwapb_gpio *gpio = platform_get_drvdata(pdev);
 | 
			
		||||
	struct bgpio_chip *bgc	= &gpio->ports[0].bgc;
 | 
			
		||||
	struct gpio_chip *gc	= &gpio->ports[0].gc;
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
	int i;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
	for (i = 0; i < gpio->nr_ports; i++) {
 | 
			
		||||
		unsigned int offset;
 | 
			
		||||
		unsigned int idx = gpio->ports[i].idx;
 | 
			
		||||
| 
						 | 
				
			
			@ -666,7 +660,7 @@ static int dwapb_gpio_resume(struct device *dev)
 | 
			
		|||
			dwapb_write(gpio, GPIO_PORTA_EOI, 0xffffffff);
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -16,10 +16,11 @@
 | 
			
		|||
#include <linux/module.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
#include <linux/io.h>
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/irq.h>
 | 
			
		||||
#include <linux/slab.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
/* FIXME: this is here for gpio_to_irq() - get rid of this! */
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
 | 
			
		||||
#include <mach/hardware.h>
 | 
			
		||||
#include <mach/gpio-ep93xx.h>
 | 
			
		||||
| 
						 | 
				
			
			@ -28,7 +29,7 @@
 | 
			
		|||
 | 
			
		||||
struct ep93xx_gpio {
 | 
			
		||||
	void __iomem		*mmio_base;
 | 
			
		||||
	struct bgpio_chip	bgc[8];
 | 
			
		||||
	struct gpio_chip	gc[8];
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/*************************************************************************
 | 
			
		||||
| 
						 | 
				
			
			@ -319,26 +320,26 @@ static int ep93xx_gpio_to_irq(struct gpio_chip *chip, unsigned offset)
 | 
			
		|||
	return 64 + gpio;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int ep93xx_gpio_add_bank(struct bgpio_chip *bgc, struct device *dev,
 | 
			
		||||
static int ep93xx_gpio_add_bank(struct gpio_chip *gc, struct device *dev,
 | 
			
		||||
	void __iomem *mmio_base, struct ep93xx_gpio_bank *bank)
 | 
			
		||||
{
 | 
			
		||||
	void __iomem *data = mmio_base + bank->data;
 | 
			
		||||
	void __iomem *dir =  mmio_base + bank->dir;
 | 
			
		||||
	int err;
 | 
			
		||||
 | 
			
		||||
	err = bgpio_init(bgc, dev, 1, data, NULL, NULL, dir, NULL, 0);
 | 
			
		||||
	err = bgpio_init(gc, dev, 1, data, NULL, NULL, dir, NULL, 0);
 | 
			
		||||
	if (err)
 | 
			
		||||
		return err;
 | 
			
		||||
 | 
			
		||||
	bgc->gc.label = bank->label;
 | 
			
		||||
	bgc->gc.base = bank->base;
 | 
			
		||||
	gc->label = bank->label;
 | 
			
		||||
	gc->base = bank->base;
 | 
			
		||||
 | 
			
		||||
	if (bank->has_debounce) {
 | 
			
		||||
		bgc->gc.set_debounce = ep93xx_gpio_set_debounce;
 | 
			
		||||
		bgc->gc.to_irq = ep93xx_gpio_to_irq;
 | 
			
		||||
		gc->set_debounce = ep93xx_gpio_set_debounce;
 | 
			
		||||
		gc->to_irq = ep93xx_gpio_to_irq;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return gpiochip_add(&bgc->gc);
 | 
			
		||||
	return gpiochip_add_data(gc, NULL);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int ep93xx_gpio_probe(struct platform_device *pdev)
 | 
			
		||||
| 
						 | 
				
			
			@ -358,10 +359,10 @@ static int ep93xx_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
		return PTR_ERR(ep93xx_gpio->mmio_base);
 | 
			
		||||
 | 
			
		||||
	for (i = 0; i < ARRAY_SIZE(ep93xx_gpio_banks); i++) {
 | 
			
		||||
		struct bgpio_chip *bgc = &ep93xx_gpio->bgc[i];
 | 
			
		||||
		struct gpio_chip *gc = &ep93xx_gpio->gc[i];
 | 
			
		||||
		struct ep93xx_gpio_bank *bank = &ep93xx_gpio_banks[i];
 | 
			
		||||
 | 
			
		||||
		if (ep93xx_gpio_add_bank(bgc, &pdev->dev,
 | 
			
		||||
		if (ep93xx_gpio_add_bank(gc, &pdev->dev,
 | 
			
		||||
					 ep93xx_gpio->mmio_base, bank))
 | 
			
		||||
			dev_warn(&pdev->dev, "Unable to add gpio bank %s\n",
 | 
			
		||||
				bank->label);
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -1,12 +1,10 @@
 | 
			
		|||
#include <linux/kernel.h>
 | 
			
		||||
#include <linux/init.h>
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
#include <linux/of_gpio.h>
 | 
			
		||||
#include <linux/io.h>
 | 
			
		||||
#include <linux/interrupt.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
 | 
			
		||||
#define ETRAX_FS_rw_pa_dout	0
 | 
			
		||||
#define ETRAX_FS_r_pa_din	4
 | 
			
		||||
| 
						 | 
				
			
			@ -67,7 +65,7 @@ struct etraxfs_gpio_block {
 | 
			
		|||
};
 | 
			
		||||
 | 
			
		||||
struct etraxfs_gpio_chip {
 | 
			
		||||
	struct bgpio_chip bgc;
 | 
			
		||||
	struct gpio_chip gc;
 | 
			
		||||
	struct etraxfs_gpio_block *block;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -176,11 +174,6 @@ static const struct etraxfs_gpio_info etraxfs_gpio_artpec3 = {
 | 
			
		|||
	.rw_intr_pins	= ARTPEC3_rw_intr_pins,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static struct etraxfs_gpio_chip *to_etraxfs(struct gpio_chip *gc)
 | 
			
		||||
{
 | 
			
		||||
	return container_of(gc, struct etraxfs_gpio_chip, bgc.gc);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static unsigned int etraxfs_gpio_chip_to_port(struct gpio_chip *gc)
 | 
			
		||||
{
 | 
			
		||||
	return gc->label[0] - 'A';
 | 
			
		||||
| 
						 | 
				
			
			@ -220,13 +213,13 @@ static unsigned int etraxfs_gpio_to_group_irq(unsigned int gpio)
 | 
			
		|||
static unsigned int etraxfs_gpio_to_group_pin(struct etraxfs_gpio_chip *chip,
 | 
			
		||||
					      unsigned int gpio)
 | 
			
		||||
{
 | 
			
		||||
	return 4 * etraxfs_gpio_chip_to_port(&chip->bgc.gc) + gpio / 8;
 | 
			
		||||
	return 4 * etraxfs_gpio_chip_to_port(&chip->gc) + gpio / 8;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void etraxfs_gpio_irq_ack(struct irq_data *d)
 | 
			
		||||
{
 | 
			
		||||
	struct etraxfs_gpio_chip *chip =
 | 
			
		||||
		to_etraxfs(irq_data_get_irq_chip_data(d));
 | 
			
		||||
		gpiochip_get_data(irq_data_get_irq_chip_data(d));
 | 
			
		||||
	struct etraxfs_gpio_block *block = chip->block;
 | 
			
		||||
	unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq);
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -236,7 +229,7 @@ static void etraxfs_gpio_irq_ack(struct irq_data *d)
 | 
			
		|||
static void etraxfs_gpio_irq_mask(struct irq_data *d)
 | 
			
		||||
{
 | 
			
		||||
	struct etraxfs_gpio_chip *chip =
 | 
			
		||||
		to_etraxfs(irq_data_get_irq_chip_data(d));
 | 
			
		||||
		gpiochip_get_data(irq_data_get_irq_chip_data(d));
 | 
			
		||||
	struct etraxfs_gpio_block *block = chip->block;
 | 
			
		||||
	unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq);
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -249,7 +242,7 @@ static void etraxfs_gpio_irq_mask(struct irq_data *d)
 | 
			
		|||
static void etraxfs_gpio_irq_unmask(struct irq_data *d)
 | 
			
		||||
{
 | 
			
		||||
	struct etraxfs_gpio_chip *chip =
 | 
			
		||||
		to_etraxfs(irq_data_get_irq_chip_data(d));
 | 
			
		||||
		gpiochip_get_data(irq_data_get_irq_chip_data(d));
 | 
			
		||||
	struct etraxfs_gpio_block *block = chip->block;
 | 
			
		||||
	unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq);
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -262,7 +255,7 @@ static void etraxfs_gpio_irq_unmask(struct irq_data *d)
 | 
			
		|||
static int etraxfs_gpio_irq_set_type(struct irq_data *d, u32 type)
 | 
			
		||||
{
 | 
			
		||||
	struct etraxfs_gpio_chip *chip =
 | 
			
		||||
		to_etraxfs(irq_data_get_irq_chip_data(d));
 | 
			
		||||
		gpiochip_get_data(irq_data_get_irq_chip_data(d));
 | 
			
		||||
	struct etraxfs_gpio_block *block = chip->block;
 | 
			
		||||
	unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq);
 | 
			
		||||
	u32 cfg;
 | 
			
		||||
| 
						 | 
				
			
			@ -299,7 +292,7 @@ static int etraxfs_gpio_irq_set_type(struct irq_data *d, u32 type)
 | 
			
		|||
static int etraxfs_gpio_irq_request_resources(struct irq_data *d)
 | 
			
		||||
{
 | 
			
		||||
	struct etraxfs_gpio_chip *chip =
 | 
			
		||||
		to_etraxfs(irq_data_get_irq_chip_data(d));
 | 
			
		||||
		gpiochip_get_data(irq_data_get_irq_chip_data(d));
 | 
			
		||||
	struct etraxfs_gpio_block *block = chip->block;
 | 
			
		||||
	unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq);
 | 
			
		||||
	int ret = -EBUSY;
 | 
			
		||||
| 
						 | 
				
			
			@ -308,7 +301,7 @@ static int etraxfs_gpio_irq_request_resources(struct irq_data *d)
 | 
			
		|||
	if (block->group[grpirq])
 | 
			
		||||
		goto out;
 | 
			
		||||
 | 
			
		||||
	ret = gpiochip_lock_as_irq(&chip->bgc.gc, d->hwirq);
 | 
			
		||||
	ret = gpiochip_lock_as_irq(&chip->gc, d->hwirq);
 | 
			
		||||
	if (ret)
 | 
			
		||||
		goto out;
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -330,13 +323,13 @@ static int etraxfs_gpio_irq_request_resources(struct irq_data *d)
 | 
			
		|||
static void etraxfs_gpio_irq_release_resources(struct irq_data *d)
 | 
			
		||||
{
 | 
			
		||||
	struct etraxfs_gpio_chip *chip =
 | 
			
		||||
		to_etraxfs(irq_data_get_irq_chip_data(d));
 | 
			
		||||
		gpiochip_get_data(irq_data_get_irq_chip_data(d));
 | 
			
		||||
	struct etraxfs_gpio_block *block = chip->block;
 | 
			
		||||
	unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq);
 | 
			
		||||
 | 
			
		||||
	spin_lock(&block->lock);
 | 
			
		||||
	block->group[grpirq] = 0;
 | 
			
		||||
	gpiochip_unlock_as_irq(&chip->bgc.gc, d->hwirq);
 | 
			
		||||
	gpiochip_unlock_as_irq(&chip->gc, d->hwirq);
 | 
			
		||||
	spin_unlock(&block->lock);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -419,7 +412,7 @@ static int etraxfs_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
 | 
			
		||||
	for (i = 0; i < info->num_ports; i++) {
 | 
			
		||||
		struct etraxfs_gpio_chip *chip = &chips[i];
 | 
			
		||||
		struct bgpio_chip *bgc = &chip->bgc;
 | 
			
		||||
		struct gpio_chip *gc = &chip->gc;
 | 
			
		||||
		const struct etraxfs_gpio_port *port = &info->ports[i];
 | 
			
		||||
		unsigned long flags = BGPIOF_READ_OUTPUT_REG_SET;
 | 
			
		||||
		void __iomem *dat = regs + port->din;
 | 
			
		||||
| 
						 | 
				
			
			@ -433,7 +426,7 @@ static int etraxfs_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
			flags = BGPIOF_NO_OUTPUT;
 | 
			
		||||
		}
 | 
			
		||||
 | 
			
		||||
		ret = bgpio_init(bgc, dev, 4,
 | 
			
		||||
		ret = bgpio_init(gc, dev, 4,
 | 
			
		||||
				 dat, set, NULL, dirout, NULL,
 | 
			
		||||
				 flags);
 | 
			
		||||
		if (ret) {
 | 
			
		||||
| 
						 | 
				
			
			@ -442,28 +435,28 @@ static int etraxfs_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
			continue;
 | 
			
		||||
		}
 | 
			
		||||
 | 
			
		||||
		bgc->gc.ngpio = port->ngpio;
 | 
			
		||||
		bgc->gc.label = port->label;
 | 
			
		||||
		gc->ngpio = port->ngpio;
 | 
			
		||||
		gc->label = port->label;
 | 
			
		||||
 | 
			
		||||
		bgc->gc.of_node = dev->of_node;
 | 
			
		||||
		bgc->gc.of_gpio_n_cells = 3;
 | 
			
		||||
		bgc->gc.of_xlate = etraxfs_gpio_of_xlate;
 | 
			
		||||
		gc->of_node = dev->of_node;
 | 
			
		||||
		gc->of_gpio_n_cells = 3;
 | 
			
		||||
		gc->of_xlate = etraxfs_gpio_of_xlate;
 | 
			
		||||
 | 
			
		||||
		ret = gpiochip_add(&bgc->gc);
 | 
			
		||||
		ret = gpiochip_add_data(gc, chip);
 | 
			
		||||
		if (ret) {
 | 
			
		||||
			dev_err(dev, "Unable to register port %s\n",
 | 
			
		||||
				bgc->gc.label);
 | 
			
		||||
				gc->label);
 | 
			
		||||
			continue;
 | 
			
		||||
		}
 | 
			
		||||
 | 
			
		||||
		if (i > 0 && !allportsirq)
 | 
			
		||||
			continue;
 | 
			
		||||
 | 
			
		||||
		ret = gpiochip_irqchip_add(&bgc->gc, &etraxfs_gpio_irq_chip, 0,
 | 
			
		||||
		ret = gpiochip_irqchip_add(gc, &etraxfs_gpio_irq_chip, 0,
 | 
			
		||||
					   handle_level_irq, IRQ_TYPE_NONE);
 | 
			
		||||
		if (ret) {
 | 
			
		||||
			dev_err(dev, "Unable to add irqchip to port %s\n",
 | 
			
		||||
				bgc->gc.label);
 | 
			
		||||
				gc->label);
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -24,7 +24,7 @@
 | 
			
		|||
#include <linux/of_gpio.h>
 | 
			
		||||
#include <linux/of_address.h>
 | 
			
		||||
#include <linux/module.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
 | 
			
		||||
#define GEF_GPIO_DIRECT		0x00
 | 
			
		||||
#define GEF_GPIO_IN		0x04
 | 
			
		||||
| 
						 | 
				
			
			@ -55,19 +55,19 @@ static int __init gef_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
{
 | 
			
		||||
	const struct of_device_id *of_id =
 | 
			
		||||
		of_match_device(gef_gpio_ids, &pdev->dev);
 | 
			
		||||
	struct bgpio_chip *bgc;
 | 
			
		||||
	struct gpio_chip *gc;
 | 
			
		||||
	void __iomem *regs;
 | 
			
		||||
	int ret;
 | 
			
		||||
 | 
			
		||||
	bgc = devm_kzalloc(&pdev->dev, sizeof(*bgc), GFP_KERNEL);
 | 
			
		||||
	if (!bgc)
 | 
			
		||||
	gc = devm_kzalloc(&pdev->dev, sizeof(*gc), GFP_KERNEL);
 | 
			
		||||
	if (!gc)
 | 
			
		||||
		return -ENOMEM;
 | 
			
		||||
 | 
			
		||||
	regs = of_iomap(pdev->dev.of_node, 0);
 | 
			
		||||
	if (!regs)
 | 
			
		||||
		return -ENOMEM;
 | 
			
		||||
 | 
			
		||||
	ret = bgpio_init(bgc, &pdev->dev, 4, regs + GEF_GPIO_IN,
 | 
			
		||||
	ret = bgpio_init(gc, &pdev->dev, 4, regs + GEF_GPIO_IN,
 | 
			
		||||
			 regs + GEF_GPIO_OUT, NULL, NULL,
 | 
			
		||||
			 regs + GEF_GPIO_DIRECT, BGPIOF_BIG_ENDIAN_BYTE_ORDER);
 | 
			
		||||
	if (ret) {
 | 
			
		||||
| 
						 | 
				
			
			@ -76,20 +76,20 @@ static int __init gef_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
	}
 | 
			
		||||
 | 
			
		||||
	/* Setup pointers to chip functions */
 | 
			
		||||
	bgc->gc.label = devm_kstrdup(&pdev->dev, pdev->dev.of_node->full_name,
 | 
			
		||||
	gc->label = devm_kstrdup(&pdev->dev, pdev->dev.of_node->full_name,
 | 
			
		||||
				     GFP_KERNEL);
 | 
			
		||||
	if (!bgc->gc.label) {
 | 
			
		||||
	if (!gc->label) {
 | 
			
		||||
		ret = -ENOMEM;
 | 
			
		||||
		goto err0;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	bgc->gc.base = -1;
 | 
			
		||||
	bgc->gc.ngpio = (u16)(uintptr_t)of_id->data;
 | 
			
		||||
	bgc->gc.of_gpio_n_cells = 2;
 | 
			
		||||
	bgc->gc.of_node = pdev->dev.of_node;
 | 
			
		||||
	gc->base = -1;
 | 
			
		||||
	gc->ngpio = (u16)(uintptr_t)of_id->data;
 | 
			
		||||
	gc->of_gpio_n_cells = 2;
 | 
			
		||||
	gc->of_node = pdev->dev.of_node;
 | 
			
		||||
 | 
			
		||||
	/* This function adds a memory mapped GPIO chip */
 | 
			
		||||
	ret = gpiochip_add(&bgc->gc);
 | 
			
		||||
	ret = gpiochip_add_data(gc, NULL);
 | 
			
		||||
	if (ret)
 | 
			
		||||
		goto err0;
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -56,12 +56,11 @@ o        `                     ~~~~\___/~~~~    ` controller in FPGA is ,.`
 | 
			
		|||
#include <linux/log2.h>
 | 
			
		||||
#include <linux/ioport.h>
 | 
			
		||||
#include <linux/io.h>
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
#include <linux/slab.h>
 | 
			
		||||
#include <linux/bitops.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
#include <linux/mod_devicetable.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
 | 
			
		||||
static void bgpio_write8(void __iomem *reg, unsigned long data)
 | 
			
		||||
{
 | 
			
		||||
| 
						 | 
				
			
			@ -125,33 +124,30 @@ static unsigned long bgpio_read32be(void __iomem *reg)
 | 
			
		|||
	return ioread32be(reg);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static unsigned long bgpio_pin2mask(struct bgpio_chip *bgc, unsigned int pin)
 | 
			
		||||
static unsigned long bgpio_pin2mask(struct gpio_chip *gc, unsigned int pin)
 | 
			
		||||
{
 | 
			
		||||
	return BIT(pin);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static unsigned long bgpio_pin2mask_be(struct bgpio_chip *bgc,
 | 
			
		||||
static unsigned long bgpio_pin2mask_be(struct gpio_chip *gc,
 | 
			
		||||
				       unsigned int pin)
 | 
			
		||||
{
 | 
			
		||||
	return BIT(bgc->bits - 1 - pin);
 | 
			
		||||
	return BIT(gc->bgpio_bits - 1 - pin);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int bgpio_get_set(struct gpio_chip *gc, unsigned int gpio)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	unsigned long pinmask = bgc->pin2mask(bgc, gpio);
 | 
			
		||||
	unsigned long pinmask = gc->pin2mask(gc, gpio);
 | 
			
		||||
 | 
			
		||||
	if (bgc->dir & pinmask)
 | 
			
		||||
		return !!(bgc->read_reg(bgc->reg_set) & pinmask);
 | 
			
		||||
	if (gc->bgpio_dir & pinmask)
 | 
			
		||||
		return !!(gc->read_reg(gc->reg_set) & pinmask);
 | 
			
		||||
	else
 | 
			
		||||
		return !!(bgc->read_reg(bgc->reg_dat) & pinmask);
 | 
			
		||||
		return !!(gc->read_reg(gc->reg_dat) & pinmask);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int bgpio_get(struct gpio_chip *gc, unsigned int gpio)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
 | 
			
		||||
	return !!(bgc->read_reg(bgc->reg_dat) & bgc->pin2mask(bgc, gpio));
 | 
			
		||||
	return !!(gc->read_reg(gc->reg_dat) & gc->pin2mask(gc, gpio));
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void bgpio_set_none(struct gpio_chip *gc, unsigned int gpio, int val)
 | 
			
		||||
| 
						 | 
				
			
			@ -160,53 +156,50 @@ static void bgpio_set_none(struct gpio_chip *gc, unsigned int gpio, int val)
 | 
			
		|||
 | 
			
		||||
static void bgpio_set(struct gpio_chip *gc, unsigned int gpio, int val)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	unsigned long mask = bgc->pin2mask(bgc, gpio);
 | 
			
		||||
	unsigned long mask = gc->pin2mask(gc, gpio);
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	if (val)
 | 
			
		||||
		bgc->data |= mask;
 | 
			
		||||
		gc->bgpio_data |= mask;
 | 
			
		||||
	else
 | 
			
		||||
		bgc->data &= ~mask;
 | 
			
		||||
		gc->bgpio_data &= ~mask;
 | 
			
		||||
 | 
			
		||||
	bgc->write_reg(bgc->reg_dat, bgc->data);
 | 
			
		||||
	gc->write_reg(gc->reg_dat, gc->bgpio_data);
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void bgpio_set_with_clear(struct gpio_chip *gc, unsigned int gpio,
 | 
			
		||||
				 int val)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	unsigned long mask = bgc->pin2mask(bgc, gpio);
 | 
			
		||||
	unsigned long mask = gc->pin2mask(gc, gpio);
 | 
			
		||||
 | 
			
		||||
	if (val)
 | 
			
		||||
		bgc->write_reg(bgc->reg_set, mask);
 | 
			
		||||
		gc->write_reg(gc->reg_set, mask);
 | 
			
		||||
	else
 | 
			
		||||
		bgc->write_reg(bgc->reg_clr, mask);
 | 
			
		||||
		gc->write_reg(gc->reg_clr, mask);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void bgpio_set_set(struct gpio_chip *gc, unsigned int gpio, int val)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	unsigned long mask = bgc->pin2mask(bgc, gpio);
 | 
			
		||||
	unsigned long mask = gc->pin2mask(gc, gpio);
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	if (val)
 | 
			
		||||
		bgc->data |= mask;
 | 
			
		||||
		gc->bgpio_data |= mask;
 | 
			
		||||
	else
 | 
			
		||||
		bgc->data &= ~mask;
 | 
			
		||||
		gc->bgpio_data &= ~mask;
 | 
			
		||||
 | 
			
		||||
	bgc->write_reg(bgc->reg_set, bgc->data);
 | 
			
		||||
	gc->write_reg(gc->reg_set, gc->bgpio_data);
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void bgpio_multiple_get_masks(struct bgpio_chip *bgc,
 | 
			
		||||
static void bgpio_multiple_get_masks(struct gpio_chip *gc,
 | 
			
		||||
				     unsigned long *mask, unsigned long *bits,
 | 
			
		||||
				     unsigned long *set_mask,
 | 
			
		||||
				     unsigned long *clear_mask)
 | 
			
		||||
| 
						 | 
				
			
			@ -216,19 +209,19 @@ static void bgpio_multiple_get_masks(struct bgpio_chip *bgc,
 | 
			
		|||
	*set_mask = 0;
 | 
			
		||||
	*clear_mask = 0;
 | 
			
		||||
 | 
			
		||||
	for (i = 0; i < bgc->bits; i++) {
 | 
			
		||||
	for (i = 0; i < gc->bgpio_bits; i++) {
 | 
			
		||||
		if (*mask == 0)
 | 
			
		||||
			break;
 | 
			
		||||
		if (__test_and_clear_bit(i, mask)) {
 | 
			
		||||
			if (test_bit(i, bits))
 | 
			
		||||
				*set_mask |= bgc->pin2mask(bgc, i);
 | 
			
		||||
				*set_mask |= gc->pin2mask(gc, i);
 | 
			
		||||
			else
 | 
			
		||||
				*clear_mask |= bgc->pin2mask(bgc, i);
 | 
			
		||||
				*clear_mask |= gc->pin2mask(gc, i);
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void bgpio_set_multiple_single_reg(struct bgpio_chip *bgc,
 | 
			
		||||
static void bgpio_set_multiple_single_reg(struct gpio_chip *gc,
 | 
			
		||||
					  unsigned long *mask,
 | 
			
		||||
					  unsigned long *bits,
 | 
			
		||||
					  void __iomem *reg)
 | 
			
		||||
| 
						 | 
				
			
			@ -236,47 +229,42 @@ static void bgpio_set_multiple_single_reg(struct bgpio_chip *bgc,
 | 
			
		|||
	unsigned long flags;
 | 
			
		||||
	unsigned long set_mask, clear_mask;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	bgpio_multiple_get_masks(bgc, mask, bits, &set_mask, &clear_mask);
 | 
			
		||||
	bgpio_multiple_get_masks(gc, mask, bits, &set_mask, &clear_mask);
 | 
			
		||||
 | 
			
		||||
	bgc->data |= set_mask;
 | 
			
		||||
	bgc->data &= ~clear_mask;
 | 
			
		||||
	gc->bgpio_data |= set_mask;
 | 
			
		||||
	gc->bgpio_data &= ~clear_mask;
 | 
			
		||||
 | 
			
		||||
	bgc->write_reg(reg, bgc->data);
 | 
			
		||||
	gc->write_reg(reg, gc->bgpio_data);
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void bgpio_set_multiple(struct gpio_chip *gc, unsigned long *mask,
 | 
			
		||||
			       unsigned long *bits)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
 | 
			
		||||
	bgpio_set_multiple_single_reg(bgc, mask, bits, bgc->reg_dat);
 | 
			
		||||
	bgpio_set_multiple_single_reg(gc, mask, bits, gc->reg_dat);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void bgpio_set_multiple_set(struct gpio_chip *gc, unsigned long *mask,
 | 
			
		||||
				   unsigned long *bits)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
 | 
			
		||||
	bgpio_set_multiple_single_reg(bgc, mask, bits, bgc->reg_set);
 | 
			
		||||
	bgpio_set_multiple_single_reg(gc, mask, bits, gc->reg_set);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void bgpio_set_multiple_with_clear(struct gpio_chip *gc,
 | 
			
		||||
					  unsigned long *mask,
 | 
			
		||||
					  unsigned long *bits)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	unsigned long set_mask, clear_mask;
 | 
			
		||||
 | 
			
		||||
	bgpio_multiple_get_masks(bgc, mask, bits, &set_mask, &clear_mask);
 | 
			
		||||
	bgpio_multiple_get_masks(gc, mask, bits, &set_mask, &clear_mask);
 | 
			
		||||
 | 
			
		||||
	if (set_mask)
 | 
			
		||||
		bgc->write_reg(bgc->reg_set, set_mask);
 | 
			
		||||
		gc->write_reg(gc->reg_set, set_mask);
 | 
			
		||||
	if (clear_mask)
 | 
			
		||||
		bgc->write_reg(bgc->reg_clr, clear_mask);
 | 
			
		||||
		gc->write_reg(gc->reg_clr, clear_mask);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int bgpio_simple_dir_in(struct gpio_chip *gc, unsigned int gpio)
 | 
			
		||||
| 
						 | 
				
			
			@ -300,111 +288,103 @@ static int bgpio_simple_dir_out(struct gpio_chip *gc, unsigned int gpio,
 | 
			
		|||
 | 
			
		||||
static int bgpio_dir_in(struct gpio_chip *gc, unsigned int gpio)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	bgc->dir &= ~bgc->pin2mask(bgc, gpio);
 | 
			
		||||
	bgc->write_reg(bgc->reg_dir, bgc->dir);
 | 
			
		||||
	gc->bgpio_dir &= ~gc->pin2mask(gc, gpio);
 | 
			
		||||
	gc->write_reg(gc->reg_dir, gc->bgpio_dir);
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int bgpio_get_dir(struct gpio_chip *gc, unsigned int gpio)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
 | 
			
		||||
	return (bgc->read_reg(bgc->reg_dir) & bgc->pin2mask(bgc, gpio)) ?
 | 
			
		||||
	       GPIOF_DIR_OUT : GPIOF_DIR_IN;
 | 
			
		||||
	/* Return 0 if output, 1 of input */
 | 
			
		||||
	return !(gc->read_reg(gc->reg_dir) & gc->pin2mask(gc, gpio));
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int bgpio_dir_out(struct gpio_chip *gc, unsigned int gpio, int val)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
 | 
			
		||||
	gc->set(gc, gpio, val);
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	bgc->dir |= bgc->pin2mask(bgc, gpio);
 | 
			
		||||
	bgc->write_reg(bgc->reg_dir, bgc->dir);
 | 
			
		||||
	gc->bgpio_dir |= gc->pin2mask(gc, gpio);
 | 
			
		||||
	gc->write_reg(gc->reg_dir, gc->bgpio_dir);
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int bgpio_dir_in_inv(struct gpio_chip *gc, unsigned int gpio)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	bgc->dir |= bgc->pin2mask(bgc, gpio);
 | 
			
		||||
	bgc->write_reg(bgc->reg_dir, bgc->dir);
 | 
			
		||||
	gc->bgpio_dir |= gc->pin2mask(gc, gpio);
 | 
			
		||||
	gc->write_reg(gc->reg_dir, gc->bgpio_dir);
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int bgpio_dir_out_inv(struct gpio_chip *gc, unsigned int gpio, int val)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
 | 
			
		||||
	gc->set(gc, gpio, val);
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&bgc->lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	bgc->dir &= ~bgc->pin2mask(bgc, gpio);
 | 
			
		||||
	bgc->write_reg(bgc->reg_dir, bgc->dir);
 | 
			
		||||
	gc->bgpio_dir &= ~gc->pin2mask(gc, gpio);
 | 
			
		||||
	gc->write_reg(gc->reg_dir, gc->bgpio_dir);
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&bgc->lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&gc->bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int bgpio_get_dir_inv(struct gpio_chip *gc, unsigned int gpio)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
 | 
			
		||||
	return (bgc->read_reg(bgc->reg_dir) & bgc->pin2mask(bgc, gpio)) ?
 | 
			
		||||
	       GPIOF_DIR_IN : GPIOF_DIR_OUT;
 | 
			
		||||
	/* Return 0 if output, 1 if input */
 | 
			
		||||
	return !!(gc->read_reg(gc->reg_dir) & gc->pin2mask(gc, gpio));
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int bgpio_setup_accessors(struct device *dev,
 | 
			
		||||
				 struct bgpio_chip *bgc,
 | 
			
		||||
				 struct gpio_chip *gc,
 | 
			
		||||
				 bool bit_be,
 | 
			
		||||
				 bool byte_be)
 | 
			
		||||
{
 | 
			
		||||
 | 
			
		||||
	switch (bgc->bits) {
 | 
			
		||||
	switch (gc->bgpio_bits) {
 | 
			
		||||
	case 8:
 | 
			
		||||
		bgc->read_reg	= bgpio_read8;
 | 
			
		||||
		bgc->write_reg	= bgpio_write8;
 | 
			
		||||
		gc->read_reg	= bgpio_read8;
 | 
			
		||||
		gc->write_reg	= bgpio_write8;
 | 
			
		||||
		break;
 | 
			
		||||
	case 16:
 | 
			
		||||
		if (byte_be) {
 | 
			
		||||
			bgc->read_reg	= bgpio_read16be;
 | 
			
		||||
			bgc->write_reg	= bgpio_write16be;
 | 
			
		||||
			gc->read_reg	= bgpio_read16be;
 | 
			
		||||
			gc->write_reg	= bgpio_write16be;
 | 
			
		||||
		} else {
 | 
			
		||||
			bgc->read_reg	= bgpio_read16;
 | 
			
		||||
			bgc->write_reg	= bgpio_write16;
 | 
			
		||||
			gc->read_reg	= bgpio_read16;
 | 
			
		||||
			gc->write_reg	= bgpio_write16;
 | 
			
		||||
		}
 | 
			
		||||
		break;
 | 
			
		||||
	case 32:
 | 
			
		||||
		if (byte_be) {
 | 
			
		||||
			bgc->read_reg	= bgpio_read32be;
 | 
			
		||||
			bgc->write_reg	= bgpio_write32be;
 | 
			
		||||
			gc->read_reg	= bgpio_read32be;
 | 
			
		||||
			gc->write_reg	= bgpio_write32be;
 | 
			
		||||
		} else {
 | 
			
		||||
			bgc->read_reg	= bgpio_read32;
 | 
			
		||||
			bgc->write_reg	= bgpio_write32;
 | 
			
		||||
			gc->read_reg	= bgpio_read32;
 | 
			
		||||
			gc->write_reg	= bgpio_write32;
 | 
			
		||||
		}
 | 
			
		||||
		break;
 | 
			
		||||
#if BITS_PER_LONG >= 64
 | 
			
		||||
| 
						 | 
				
			
			@ -414,17 +394,17 @@ static int bgpio_setup_accessors(struct device *dev,
 | 
			
		|||
				"64 bit big endian byte order unsupported\n");
 | 
			
		||||
			return -EINVAL;
 | 
			
		||||
		} else {
 | 
			
		||||
			bgc->read_reg	= bgpio_read64;
 | 
			
		||||
			bgc->write_reg	= bgpio_write64;
 | 
			
		||||
			gc->read_reg	= bgpio_read64;
 | 
			
		||||
			gc->write_reg	= bgpio_write64;
 | 
			
		||||
		}
 | 
			
		||||
		break;
 | 
			
		||||
#endif /* BITS_PER_LONG >= 64 */
 | 
			
		||||
	default:
 | 
			
		||||
		dev_err(dev, "unsupported data width %u bits\n", bgc->bits);
 | 
			
		||||
		dev_err(dev, "unsupported data width %u bits\n", gc->bgpio_bits);
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	bgc->pin2mask = bit_be ? bgpio_pin2mask_be : bgpio_pin2mask;
 | 
			
		||||
	gc->pin2mask = bit_be ? bgpio_pin2mask_be : bgpio_pin2mask;
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			@ -451,44 +431,44 @@ static int bgpio_setup_accessors(struct device *dev,
 | 
			
		|||
 *	- an input direction register (named "dirin") where a 1 bit indicates
 | 
			
		||||
 *	the GPIO is an input.
 | 
			
		||||
 */
 | 
			
		||||
static int bgpio_setup_io(struct bgpio_chip *bgc,
 | 
			
		||||
static int bgpio_setup_io(struct gpio_chip *gc,
 | 
			
		||||
			  void __iomem *dat,
 | 
			
		||||
			  void __iomem *set,
 | 
			
		||||
			  void __iomem *clr,
 | 
			
		||||
			  unsigned long flags)
 | 
			
		||||
{
 | 
			
		||||
 | 
			
		||||
	bgc->reg_dat = dat;
 | 
			
		||||
	if (!bgc->reg_dat)
 | 
			
		||||
	gc->reg_dat = dat;
 | 
			
		||||
	if (!gc->reg_dat)
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	if (set && clr) {
 | 
			
		||||
		bgc->reg_set = set;
 | 
			
		||||
		bgc->reg_clr = clr;
 | 
			
		||||
		bgc->gc.set = bgpio_set_with_clear;
 | 
			
		||||
		bgc->gc.set_multiple = bgpio_set_multiple_with_clear;
 | 
			
		||||
		gc->reg_set = set;
 | 
			
		||||
		gc->reg_clr = clr;
 | 
			
		||||
		gc->set = bgpio_set_with_clear;
 | 
			
		||||
		gc->set_multiple = bgpio_set_multiple_with_clear;
 | 
			
		||||
	} else if (set && !clr) {
 | 
			
		||||
		bgc->reg_set = set;
 | 
			
		||||
		bgc->gc.set = bgpio_set_set;
 | 
			
		||||
		bgc->gc.set_multiple = bgpio_set_multiple_set;
 | 
			
		||||
		gc->reg_set = set;
 | 
			
		||||
		gc->set = bgpio_set_set;
 | 
			
		||||
		gc->set_multiple = bgpio_set_multiple_set;
 | 
			
		||||
	} else if (flags & BGPIOF_NO_OUTPUT) {
 | 
			
		||||
		bgc->gc.set = bgpio_set_none;
 | 
			
		||||
		bgc->gc.set_multiple = NULL;
 | 
			
		||||
		gc->set = bgpio_set_none;
 | 
			
		||||
		gc->set_multiple = NULL;
 | 
			
		||||
	} else {
 | 
			
		||||
		bgc->gc.set = bgpio_set;
 | 
			
		||||
		bgc->gc.set_multiple = bgpio_set_multiple;
 | 
			
		||||
		gc->set = bgpio_set;
 | 
			
		||||
		gc->set_multiple = bgpio_set_multiple;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (!(flags & BGPIOF_UNREADABLE_REG_SET) &&
 | 
			
		||||
	    (flags & BGPIOF_READ_OUTPUT_REG_SET))
 | 
			
		||||
		bgc->gc.get = bgpio_get_set;
 | 
			
		||||
		gc->get = bgpio_get_set;
 | 
			
		||||
	else
 | 
			
		||||
		bgc->gc.get = bgpio_get;
 | 
			
		||||
		gc->get = bgpio_get;
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int bgpio_setup_direction(struct bgpio_chip *bgc,
 | 
			
		||||
static int bgpio_setup_direction(struct gpio_chip *gc,
 | 
			
		||||
				 void __iomem *dirout,
 | 
			
		||||
				 void __iomem *dirin,
 | 
			
		||||
				 unsigned long flags)
 | 
			
		||||
| 
						 | 
				
			
			@ -496,21 +476,21 @@ static int bgpio_setup_direction(struct bgpio_chip *bgc,
 | 
			
		|||
	if (dirout && dirin) {
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
	} else if (dirout) {
 | 
			
		||||
		bgc->reg_dir = dirout;
 | 
			
		||||
		bgc->gc.direction_output = bgpio_dir_out;
 | 
			
		||||
		bgc->gc.direction_input = bgpio_dir_in;
 | 
			
		||||
		bgc->gc.get_direction = bgpio_get_dir;
 | 
			
		||||
		gc->reg_dir = dirout;
 | 
			
		||||
		gc->direction_output = bgpio_dir_out;
 | 
			
		||||
		gc->direction_input = bgpio_dir_in;
 | 
			
		||||
		gc->get_direction = bgpio_get_dir;
 | 
			
		||||
	} else if (dirin) {
 | 
			
		||||
		bgc->reg_dir = dirin;
 | 
			
		||||
		bgc->gc.direction_output = bgpio_dir_out_inv;
 | 
			
		||||
		bgc->gc.direction_input = bgpio_dir_in_inv;
 | 
			
		||||
		bgc->gc.get_direction = bgpio_get_dir_inv;
 | 
			
		||||
		gc->reg_dir = dirin;
 | 
			
		||||
		gc->direction_output = bgpio_dir_out_inv;
 | 
			
		||||
		gc->direction_input = bgpio_dir_in_inv;
 | 
			
		||||
		gc->get_direction = bgpio_get_dir_inv;
 | 
			
		||||
	} else {
 | 
			
		||||
		if (flags & BGPIOF_NO_OUTPUT)
 | 
			
		||||
			bgc->gc.direction_output = bgpio_dir_out_err;
 | 
			
		||||
			gc->direction_output = bgpio_dir_out_err;
 | 
			
		||||
		else
 | 
			
		||||
			bgc->gc.direction_output = bgpio_simple_dir_out;
 | 
			
		||||
		bgc->gc.direction_input = bgpio_simple_dir_in;
 | 
			
		||||
			gc->direction_output = bgpio_simple_dir_out;
 | 
			
		||||
		gc->direction_input = bgpio_simple_dir_in;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
| 
						 | 
				
			
			@ -524,14 +504,7 @@ static int bgpio_request(struct gpio_chip *chip, unsigned gpio_pin)
 | 
			
		|||
	return -EINVAL;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int bgpio_remove(struct bgpio_chip *bgc)
 | 
			
		||||
{
 | 
			
		||||
	gpiochip_remove(&bgc->gc);
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
EXPORT_SYMBOL_GPL(bgpio_remove);
 | 
			
		||||
 | 
			
		||||
int bgpio_init(struct bgpio_chip *bgc, struct device *dev,
 | 
			
		||||
int bgpio_init(struct gpio_chip *gc, struct device *dev,
 | 
			
		||||
	       unsigned long sz, void __iomem *dat, void __iomem *set,
 | 
			
		||||
	       void __iomem *clr, void __iomem *dirout, void __iomem *dirin,
 | 
			
		||||
	       unsigned long flags)
 | 
			
		||||
| 
						 | 
				
			
			@ -541,36 +514,36 @@ int bgpio_init(struct bgpio_chip *bgc, struct device *dev,
 | 
			
		|||
	if (!is_power_of_2(sz))
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	bgc->bits = sz * 8;
 | 
			
		||||
	if (bgc->bits > BITS_PER_LONG)
 | 
			
		||||
	gc->bgpio_bits = sz * 8;
 | 
			
		||||
	if (gc->bgpio_bits > BITS_PER_LONG)
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	spin_lock_init(&bgc->lock);
 | 
			
		||||
	bgc->gc.parent = dev;
 | 
			
		||||
	bgc->gc.label = dev_name(dev);
 | 
			
		||||
	bgc->gc.base = -1;
 | 
			
		||||
	bgc->gc.ngpio = bgc->bits;
 | 
			
		||||
	bgc->gc.request = bgpio_request;
 | 
			
		||||
	spin_lock_init(&gc->bgpio_lock);
 | 
			
		||||
	gc->parent = dev;
 | 
			
		||||
	gc->label = dev_name(dev);
 | 
			
		||||
	gc->base = -1;
 | 
			
		||||
	gc->ngpio = gc->bgpio_bits;
 | 
			
		||||
	gc->request = bgpio_request;
 | 
			
		||||
 | 
			
		||||
	ret = bgpio_setup_io(bgc, dat, set, clr, flags);
 | 
			
		||||
	ret = bgpio_setup_io(gc, dat, set, clr, flags);
 | 
			
		||||
	if (ret)
 | 
			
		||||
		return ret;
 | 
			
		||||
 | 
			
		||||
	ret = bgpio_setup_accessors(dev, bgc, flags & BGPIOF_BIG_ENDIAN,
 | 
			
		||||
	ret = bgpio_setup_accessors(dev, gc, flags & BGPIOF_BIG_ENDIAN,
 | 
			
		||||
				    flags & BGPIOF_BIG_ENDIAN_BYTE_ORDER);
 | 
			
		||||
	if (ret)
 | 
			
		||||
		return ret;
 | 
			
		||||
 | 
			
		||||
	ret = bgpio_setup_direction(bgc, dirout, dirin, flags);
 | 
			
		||||
	ret = bgpio_setup_direction(gc, dirout, dirin, flags);
 | 
			
		||||
	if (ret)
 | 
			
		||||
		return ret;
 | 
			
		||||
 | 
			
		||||
	bgc->data = bgc->read_reg(bgc->reg_dat);
 | 
			
		||||
	if (bgc->gc.set == bgpio_set_set &&
 | 
			
		||||
	gc->bgpio_data = gc->read_reg(gc->reg_dat);
 | 
			
		||||
	if (gc->set == bgpio_set_set &&
 | 
			
		||||
			!(flags & BGPIOF_UNREADABLE_REG_SET))
 | 
			
		||||
		bgc->data = bgc->read_reg(bgc->reg_set);
 | 
			
		||||
	if (bgc->reg_dir && !(flags & BGPIOF_UNREADABLE_REG_DIR))
 | 
			
		||||
		bgc->dir = bgc->read_reg(bgc->reg_dir);
 | 
			
		||||
		gc->bgpio_data = gc->read_reg(gc->reg_set);
 | 
			
		||||
	if (gc->reg_dir && !(flags & BGPIOF_UNREADABLE_REG_DIR))
 | 
			
		||||
		gc->bgpio_dir = gc->read_reg(gc->reg_dir);
 | 
			
		||||
 | 
			
		||||
	return ret;
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			@ -608,7 +581,7 @@ static int bgpio_pdev_probe(struct platform_device *pdev)
 | 
			
		|||
	unsigned long sz;
 | 
			
		||||
	unsigned long flags = pdev->id_entry->driver_data;
 | 
			
		||||
	int err;
 | 
			
		||||
	struct bgpio_chip *bgc;
 | 
			
		||||
	struct gpio_chip *gc;
 | 
			
		||||
	struct bgpio_pdata *pdata = dev_get_platdata(dev);
 | 
			
		||||
 | 
			
		||||
	r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dat");
 | 
			
		||||
| 
						 | 
				
			
			@ -637,32 +610,33 @@ static int bgpio_pdev_probe(struct platform_device *pdev)
 | 
			
		|||
	if (IS_ERR(dirin))
 | 
			
		||||
		return PTR_ERR(dirin);
 | 
			
		||||
 | 
			
		||||
	bgc = devm_kzalloc(&pdev->dev, sizeof(*bgc), GFP_KERNEL);
 | 
			
		||||
	if (!bgc)
 | 
			
		||||
	gc = devm_kzalloc(&pdev->dev, sizeof(*gc), GFP_KERNEL);
 | 
			
		||||
	if (!gc)
 | 
			
		||||
		return -ENOMEM;
 | 
			
		||||
 | 
			
		||||
	err = bgpio_init(bgc, dev, sz, dat, set, clr, dirout, dirin, flags);
 | 
			
		||||
	err = bgpio_init(gc, dev, sz, dat, set, clr, dirout, dirin, flags);
 | 
			
		||||
	if (err)
 | 
			
		||||
		return err;
 | 
			
		||||
 | 
			
		||||
	if (pdata) {
 | 
			
		||||
		if (pdata->label)
 | 
			
		||||
			bgc->gc.label = pdata->label;
 | 
			
		||||
		bgc->gc.base = pdata->base;
 | 
			
		||||
			gc->label = pdata->label;
 | 
			
		||||
		gc->base = pdata->base;
 | 
			
		||||
		if (pdata->ngpio > 0)
 | 
			
		||||
			bgc->gc.ngpio = pdata->ngpio;
 | 
			
		||||
			gc->ngpio = pdata->ngpio;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	platform_set_drvdata(pdev, bgc);
 | 
			
		||||
	platform_set_drvdata(pdev, gc);
 | 
			
		||||
 | 
			
		||||
	return gpiochip_add(&bgc->gc);
 | 
			
		||||
	return gpiochip_add_data(gc, NULL);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int bgpio_pdev_remove(struct platform_device *pdev)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = platform_get_drvdata(pdev);
 | 
			
		||||
	struct gpio_chip *gc = platform_get_drvdata(pdev);
 | 
			
		||||
 | 
			
		||||
	return bgpio_remove(bgc);
 | 
			
		||||
	gpiochip_remove(gc);
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static const struct platform_device_id bgpio_id_table[] = {
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -31,7 +31,7 @@
 | 
			
		|||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/slab.h>
 | 
			
		||||
#include <linux/err.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
#include <linux/interrupt.h>
 | 
			
		||||
#include <linux/irq.h>
 | 
			
		||||
#include <linux/irqdomain.h>
 | 
			
		||||
| 
						 | 
				
			
			@ -63,7 +63,7 @@ struct grgpio_lirq {
 | 
			
		|||
};
 | 
			
		||||
 | 
			
		||||
struct grgpio_priv {
 | 
			
		||||
	struct bgpio_chip bgc;
 | 
			
		||||
	struct gpio_chip gc;
 | 
			
		||||
	void __iomem *regs;
 | 
			
		||||
	struct device *dev;
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -92,29 +92,22 @@ struct grgpio_priv {
 | 
			
		|||
	struct grgpio_lirq lirqs[GRGPIO_MAX_NGPIO];
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static inline struct grgpio_priv *grgpio_gc_to_priv(struct gpio_chip *gc)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
 | 
			
		||||
	return container_of(bgc, struct grgpio_priv, bgc);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void grgpio_set_imask(struct grgpio_priv *priv, unsigned int offset,
 | 
			
		||||
			     int val)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = &priv->bgc;
 | 
			
		||||
	unsigned long mask = bgc->pin2mask(bgc, offset);
 | 
			
		||||
	struct gpio_chip *gc = &priv->gc;
 | 
			
		||||
	unsigned long mask = gc->pin2mask(gc, offset);
 | 
			
		||||
 | 
			
		||||
	if (val)
 | 
			
		||||
		priv->imask |= mask;
 | 
			
		||||
	else
 | 
			
		||||
		priv->imask &= ~mask;
 | 
			
		||||
	bgc->write_reg(priv->regs + GRGPIO_IMASK, priv->imask);
 | 
			
		||||
	gc->write_reg(priv->regs + GRGPIO_IMASK, priv->imask);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int grgpio_to_irq(struct gpio_chip *gc, unsigned offset)
 | 
			
		||||
{
 | 
			
		||||
	struct grgpio_priv *priv = grgpio_gc_to_priv(gc);
 | 
			
		||||
	struct grgpio_priv *priv = gpiochip_get_data(gc);
 | 
			
		||||
 | 
			
		||||
	if (offset >= gc->ngpio)
 | 
			
		||||
		return -ENXIO;
 | 
			
		||||
| 
						 | 
				
			
			@ -158,15 +151,15 @@ static int grgpio_irq_set_type(struct irq_data *d, unsigned int type)
 | 
			
		|||
		return -EINVAL;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	ipol = priv->bgc.read_reg(priv->regs + GRGPIO_IPOL) & ~mask;
 | 
			
		||||
	iedge = priv->bgc.read_reg(priv->regs + GRGPIO_IEDGE) & ~mask;
 | 
			
		||||
	ipol = priv->gc.read_reg(priv->regs + GRGPIO_IPOL) & ~mask;
 | 
			
		||||
	iedge = priv->gc.read_reg(priv->regs + GRGPIO_IEDGE) & ~mask;
 | 
			
		||||
 | 
			
		||||
	priv->bgc.write_reg(priv->regs + GRGPIO_IPOL, ipol | pol);
 | 
			
		||||
	priv->bgc.write_reg(priv->regs + GRGPIO_IEDGE, iedge | edge);
 | 
			
		||||
	priv->gc.write_reg(priv->regs + GRGPIO_IPOL, ipol | pol);
 | 
			
		||||
	priv->gc.write_reg(priv->regs + GRGPIO_IEDGE, iedge | edge);
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			@ -177,11 +170,11 @@ static void grgpio_irq_mask(struct irq_data *d)
 | 
			
		|||
	int offset = d->hwirq;
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	grgpio_set_imask(priv, offset, 0);
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void grgpio_irq_unmask(struct irq_data *d)
 | 
			
		||||
| 
						 | 
				
			
			@ -190,11 +183,11 @@ static void grgpio_irq_unmask(struct irq_data *d)
 | 
			
		|||
	int offset = d->hwirq;
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	grgpio_set_imask(priv, offset, 1);
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static struct irq_chip grgpio_irq_chip = {
 | 
			
		||||
| 
						 | 
				
			
			@ -207,12 +200,12 @@ static struct irq_chip grgpio_irq_chip = {
 | 
			
		|||
static irqreturn_t grgpio_irq_handler(int irq, void *dev)
 | 
			
		||||
{
 | 
			
		||||
	struct grgpio_priv *priv = dev;
 | 
			
		||||
	int ngpio = priv->bgc.gc.ngpio;
 | 
			
		||||
	int ngpio = priv->gc.ngpio;
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
	int i;
 | 
			
		||||
	int match = 0;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	/*
 | 
			
		||||
	 * For each gpio line, call its interrupt handler if it its underlying
 | 
			
		||||
| 
						 | 
				
			
			@ -228,7 +221,7 @@ static irqreturn_t grgpio_irq_handler(int irq, void *dev)
 | 
			
		|||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	if (!match)
 | 
			
		||||
		dev_warn(priv->dev, "No gpio line matched irq %d\n", irq);
 | 
			
		||||
| 
						 | 
				
			
			@ -260,7 +253,7 @@ static int grgpio_irq_map(struct irq_domain *d, unsigned int irq,
 | 
			
		|||
	dev_dbg(priv->dev, "Mapping irq %d for gpio line %d\n",
 | 
			
		||||
		irq, offset);
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	/* Request underlying irq if not already requested */
 | 
			
		||||
	lirq->irq = irq;
 | 
			
		||||
| 
						 | 
				
			
			@ -273,14 +266,14 @@ static int grgpio_irq_map(struct irq_domain *d, unsigned int irq,
 | 
			
		|||
				"Could not request underlying irq %d\n",
 | 
			
		||||
				uirq->uirq);
 | 
			
		||||
 | 
			
		||||
			spin_unlock_irqrestore(&priv->bgc.lock, flags);
 | 
			
		||||
			spin_unlock_irqrestore(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
			return ret;
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
	uirq->refcnt++;
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	/* Setup irq  */
 | 
			
		||||
	irq_set_chip_data(irq, priv);
 | 
			
		||||
| 
						 | 
				
			
			@ -298,13 +291,13 @@ static void grgpio_irq_unmap(struct irq_domain *d, unsigned int irq)
 | 
			
		|||
	struct grgpio_lirq *lirq;
 | 
			
		||||
	struct grgpio_uirq *uirq;
 | 
			
		||||
	unsigned long flags;
 | 
			
		||||
	int ngpio = priv->bgc.gc.ngpio;
 | 
			
		||||
	int ngpio = priv->gc.ngpio;
 | 
			
		||||
	int i;
 | 
			
		||||
 | 
			
		||||
	irq_set_chip_and_handler(irq, NULL, NULL);
 | 
			
		||||
	irq_set_chip_data(irq, NULL);
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	/* Free underlying irq if last user unmapped */
 | 
			
		||||
	index = -1;
 | 
			
		||||
| 
						 | 
				
			
			@ -326,7 +319,7 @@ static void grgpio_irq_unmap(struct irq_domain *d, unsigned int irq)
 | 
			
		|||
			free_irq(uirq->uirq, priv);
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	spin_unlock_irqrestore(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static const struct irq_domain_ops grgpio_irq_domain_ops = {
 | 
			
		||||
| 
						 | 
				
			
			@ -341,7 +334,6 @@ static int grgpio_probe(struct platform_device *ofdev)
 | 
			
		|||
	struct device_node *np = ofdev->dev.of_node;
 | 
			
		||||
	void  __iomem *regs;
 | 
			
		||||
	struct gpio_chip *gc;
 | 
			
		||||
	struct bgpio_chip *bgc;
 | 
			
		||||
	struct grgpio_priv *priv;
 | 
			
		||||
	struct resource *res;
 | 
			
		||||
	int err;
 | 
			
		||||
| 
						 | 
				
			
			@ -359,8 +351,8 @@ static int grgpio_probe(struct platform_device *ofdev)
 | 
			
		|||
	if (IS_ERR(regs))
 | 
			
		||||
		return PTR_ERR(regs);
 | 
			
		||||
 | 
			
		||||
	bgc = &priv->bgc;
 | 
			
		||||
	err = bgpio_init(bgc, &ofdev->dev, 4, regs + GRGPIO_DATA,
 | 
			
		||||
	gc = &priv->gc;
 | 
			
		||||
	err = bgpio_init(gc, &ofdev->dev, 4, regs + GRGPIO_DATA,
 | 
			
		||||
			 regs + GRGPIO_OUTPUT, NULL, regs + GRGPIO_DIR, NULL,
 | 
			
		||||
			 BGPIOF_BIG_ENDIAN_BYTE_ORDER);
 | 
			
		||||
	if (err) {
 | 
			
		||||
| 
						 | 
				
			
			@ -369,10 +361,9 @@ static int grgpio_probe(struct platform_device *ofdev)
 | 
			
		|||
	}
 | 
			
		||||
 | 
			
		||||
	priv->regs = regs;
 | 
			
		||||
	priv->imask = bgc->read_reg(regs + GRGPIO_IMASK);
 | 
			
		||||
	priv->imask = gc->read_reg(regs + GRGPIO_IMASK);
 | 
			
		||||
	priv->dev = &ofdev->dev;
 | 
			
		||||
 | 
			
		||||
	gc = &bgc->gc;
 | 
			
		||||
	gc->of_node = np;
 | 
			
		||||
	gc->owner = THIS_MODULE;
 | 
			
		||||
	gc->to_irq = grgpio_to_irq;
 | 
			
		||||
| 
						 | 
				
			
			@ -435,7 +426,7 @@ static int grgpio_probe(struct platform_device *ofdev)
 | 
			
		|||
 | 
			
		||||
	platform_set_drvdata(ofdev, priv);
 | 
			
		||||
 | 
			
		||||
	err = gpiochip_add(gc);
 | 
			
		||||
	err = gpiochip_add_data(gc, priv);
 | 
			
		||||
	if (err) {
 | 
			
		||||
		dev_err(&ofdev->dev, "Could not add gpiochip\n");
 | 
			
		||||
		if (priv->domain)
 | 
			
		||||
| 
						 | 
				
			
			@ -456,7 +447,7 @@ static int grgpio_remove(struct platform_device *ofdev)
 | 
			
		|||
	int i;
 | 
			
		||||
	int ret = 0;
 | 
			
		||||
 | 
			
		||||
	spin_lock_irqsave(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_lock_irqsave(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	if (priv->domain) {
 | 
			
		||||
		for (i = 0; i < GRGPIO_MAX_NGPIO; i++) {
 | 
			
		||||
| 
						 | 
				
			
			@ -467,13 +458,13 @@ static int grgpio_remove(struct platform_device *ofdev)
 | 
			
		|||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	gpiochip_remove(&priv->bgc.gc);
 | 
			
		||||
	gpiochip_remove(&priv->gc);
 | 
			
		||||
 | 
			
		||||
	if (priv->domain)
 | 
			
		||||
		irq_domain_remove(priv->domain);
 | 
			
		||||
 | 
			
		||||
out:
 | 
			
		||||
	spin_unlock_irqrestore(&priv->bgc.lock, flags);
 | 
			
		||||
	spin_unlock_irqrestore(&priv->gc.bgpio_lock, flags);
 | 
			
		||||
 | 
			
		||||
	return ret;
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -14,7 +14,6 @@
 | 
			
		|||
#include <linux/init.h>
 | 
			
		||||
#include <linux/irq.h>
 | 
			
		||||
#include <linux/io.h>
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
#include <linux/module.h>
 | 
			
		||||
#include <linux/of_address.h>
 | 
			
		||||
| 
						 | 
				
			
			@ -23,7 +22,7 @@
 | 
			
		|||
#include <linux/delay.h>
 | 
			
		||||
#include <linux/timer.h>
 | 
			
		||||
#include <linux/bitops.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
 | 
			
		||||
#define GPIO_DATA_OUT		0x00
 | 
			
		||||
#define GPIO_DATA_IN		0x04
 | 
			
		||||
| 
						 | 
				
			
			@ -33,12 +32,12 @@ static int moxart_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
{
 | 
			
		||||
	struct device *dev = &pdev->dev;
 | 
			
		||||
	struct resource *res;
 | 
			
		||||
	struct bgpio_chip *bgc;
 | 
			
		||||
	struct gpio_chip *gc;
 | 
			
		||||
	void __iomem *base;
 | 
			
		||||
	int ret;
 | 
			
		||||
 | 
			
		||||
	bgc = devm_kzalloc(dev, sizeof(*bgc), GFP_KERNEL);
 | 
			
		||||
	if (!bgc)
 | 
			
		||||
	gc = devm_kzalloc(dev, sizeof(*gc), GFP_KERNEL);
 | 
			
		||||
	if (!gc)
 | 
			
		||||
		return -ENOMEM;
 | 
			
		||||
 | 
			
		||||
	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 | 
			
		||||
| 
						 | 
				
			
			@ -46,7 +45,7 @@ static int moxart_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
	if (IS_ERR(base))
 | 
			
		||||
		return PTR_ERR(base);
 | 
			
		||||
 | 
			
		||||
	ret = bgpio_init(bgc, dev, 4, base + GPIO_DATA_IN,
 | 
			
		||||
	ret = bgpio_init(gc, dev, 4, base + GPIO_DATA_IN,
 | 
			
		||||
			 base + GPIO_DATA_OUT, NULL,
 | 
			
		||||
			 base + GPIO_PIN_DIRECTION, NULL,
 | 
			
		||||
			 BGPIOF_READ_OUTPUT_REG_SET);
 | 
			
		||||
| 
						 | 
				
			
			@ -55,16 +54,16 @@ static int moxart_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
		return ret;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	bgc->gc.label = "moxart-gpio";
 | 
			
		||||
	bgc->gc.request = gpiochip_generic_request;
 | 
			
		||||
	bgc->gc.free = gpiochip_generic_free;
 | 
			
		||||
	bgc->data = bgc->read_reg(bgc->reg_set);
 | 
			
		||||
	bgc->gc.base = 0;
 | 
			
		||||
	bgc->gc.ngpio = 32;
 | 
			
		||||
	bgc->gc.parent = dev;
 | 
			
		||||
	bgc->gc.owner = THIS_MODULE;
 | 
			
		||||
	gc->label = "moxart-gpio";
 | 
			
		||||
	gc->request = gpiochip_generic_request;
 | 
			
		||||
	gc->free = gpiochip_generic_free;
 | 
			
		||||
	gc->bgpio_data = bgc->read_reg(bgc->reg_set);
 | 
			
		||||
	gc->base = 0;
 | 
			
		||||
	gc->ngpio = 32;
 | 
			
		||||
	gc->parent = dev;
 | 
			
		||||
	gc->owner = THIS_MODULE;
 | 
			
		||||
 | 
			
		||||
	ret = gpiochip_add(&bgc->gc);
 | 
			
		||||
	ret = gpiochip_add_data(gc, NULL);
 | 
			
		||||
	if (ret) {
 | 
			
		||||
		dev_err(dev, "%s: gpiochip_add failed\n",
 | 
			
		||||
			dev->of_node->full_name);
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -26,10 +26,11 @@
 | 
			
		|||
#include <linux/irq.h>
 | 
			
		||||
#include <linux/irqdomain.h>
 | 
			
		||||
#include <linux/irqchip/chained_irq.h>
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
#include <linux/slab.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
/* FIXME: for gpio_get_value() replace this with direct register read */
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/of.h>
 | 
			
		||||
#include <linux/of_device.h>
 | 
			
		||||
#include <linux/module.h>
 | 
			
		||||
| 
						 | 
				
			
			@ -64,7 +65,7 @@ struct mxc_gpio_port {
 | 
			
		|||
	int irq;
 | 
			
		||||
	int irq_high;
 | 
			
		||||
	struct irq_domain *domain;
 | 
			
		||||
	struct bgpio_chip bgc;
 | 
			
		||||
	struct gpio_chip gc;
 | 
			
		||||
	u32 both_edges;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -172,7 +173,7 @@ static int gpio_set_irq_type(struct irq_data *d, u32 type)
 | 
			
		|||
	struct mxc_gpio_port *port = gc->private;
 | 
			
		||||
	u32 bit, val;
 | 
			
		||||
	u32 gpio_idx = d->hwirq;
 | 
			
		||||
	u32 gpio = port->bgc.gc.base + gpio_idx;
 | 
			
		||||
	u32 gpio = port->gc.base + gpio_idx;
 | 
			
		||||
	int edge;
 | 
			
		||||
	void __iomem *reg = port->base;
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -398,9 +399,7 @@ static void mxc_gpio_get_hw(struct platform_device *pdev)
 | 
			
		|||
 | 
			
		||||
static int mxc_gpio_to_irq(struct gpio_chip *gc, unsigned offset)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	struct mxc_gpio_port *port =
 | 
			
		||||
		container_of(bgc, struct mxc_gpio_port, bgc);
 | 
			
		||||
	struct mxc_gpio_port *port = gpiochip_get_data(gc);
 | 
			
		||||
 | 
			
		||||
	return irq_find_mapping(port->domain, offset);
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			@ -451,7 +450,7 @@ static int mxc_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
							 port);
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	err = bgpio_init(&port->bgc, &pdev->dev, 4,
 | 
			
		||||
	err = bgpio_init(&port->gc, &pdev->dev, 4,
 | 
			
		||||
			 port->base + GPIO_PSR,
 | 
			
		||||
			 port->base + GPIO_DR, NULL,
 | 
			
		||||
			 port->base + GPIO_GDIR, NULL,
 | 
			
		||||
| 
						 | 
				
			
			@ -459,13 +458,13 @@ static int mxc_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
	if (err)
 | 
			
		||||
		goto out_bgio;
 | 
			
		||||
 | 
			
		||||
	port->bgc.gc.to_irq = mxc_gpio_to_irq;
 | 
			
		||||
	port->bgc.gc.base = (pdev->id < 0) ? of_alias_get_id(np, "gpio") * 32 :
 | 
			
		||||
	port->gc.to_irq = mxc_gpio_to_irq;
 | 
			
		||||
	port->gc.base = (pdev->id < 0) ? of_alias_get_id(np, "gpio") * 32 :
 | 
			
		||||
					     pdev->id * 32;
 | 
			
		||||
 | 
			
		||||
	err = gpiochip_add(&port->bgc.gc);
 | 
			
		||||
	err = gpiochip_add_data(&port->gc, port);
 | 
			
		||||
	if (err)
 | 
			
		||||
		goto out_bgpio_remove;
 | 
			
		||||
		goto out_bgio;
 | 
			
		||||
 | 
			
		||||
	irq_base = irq_alloc_descs(-1, 0, 32, numa_node_id());
 | 
			
		||||
	if (irq_base < 0) {
 | 
			
		||||
| 
						 | 
				
			
			@ -494,9 +493,7 @@ static int mxc_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
out_irqdesc_free:
 | 
			
		||||
	irq_free_descs(irq_base, 32);
 | 
			
		||||
out_gpiochip_remove:
 | 
			
		||||
	gpiochip_remove(&port->bgc.gc);
 | 
			
		||||
out_bgpio_remove:
 | 
			
		||||
	bgpio_remove(&port->bgc);
 | 
			
		||||
	gpiochip_remove(&port->gc);
 | 
			
		||||
out_bgio:
 | 
			
		||||
	dev_info(&pdev->dev, "%s failed with errno %d\n", __func__, err);
 | 
			
		||||
	return err;
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -26,13 +26,14 @@
 | 
			
		|||
#include <linux/io.h>
 | 
			
		||||
#include <linux/irq.h>
 | 
			
		||||
#include <linux/irqdomain.h>
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/of.h>
 | 
			
		||||
#include <linux/of_address.h>
 | 
			
		||||
#include <linux/of_device.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
#include <linux/slab.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
/* FIXME: for gpio_get_value(), replace this by direct register read */
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/module.h>
 | 
			
		||||
 | 
			
		||||
#define MXS_SET		0x4
 | 
			
		||||
| 
						 | 
				
			
			@ -64,7 +65,7 @@ struct mxs_gpio_port {
 | 
			
		|||
	int id;
 | 
			
		||||
	int irq;
 | 
			
		||||
	struct irq_domain *domain;
 | 
			
		||||
	struct bgpio_chip bgc;
 | 
			
		||||
	struct gpio_chip gc;
 | 
			
		||||
	enum mxs_gpio_id devid;
 | 
			
		||||
	u32 both_edges;
 | 
			
		||||
};
 | 
			
		||||
| 
						 | 
				
			
			@ -93,7 +94,7 @@ static int mxs_gpio_set_irq_type(struct irq_data *d, unsigned int type)
 | 
			
		|||
	port->both_edges &= ~pin_mask;
 | 
			
		||||
	switch (type) {
 | 
			
		||||
	case IRQ_TYPE_EDGE_BOTH:
 | 
			
		||||
		val = gpio_get_value(port->bgc.gc.base + d->hwirq);
 | 
			
		||||
		val = gpio_get_value(port->gc.base + d->hwirq);
 | 
			
		||||
		if (val)
 | 
			
		||||
			edge = GPIO_INT_FALL_EDGE;
 | 
			
		||||
		else
 | 
			
		||||
| 
						 | 
				
			
			@ -225,18 +226,14 @@ static int __init mxs_gpio_init_gc(struct mxs_gpio_port *port, int irq_base)
 | 
			
		|||
 | 
			
		||||
static int mxs_gpio_to_irq(struct gpio_chip *gc, unsigned offset)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	struct mxs_gpio_port *port =
 | 
			
		||||
		container_of(bgc, struct mxs_gpio_port, bgc);
 | 
			
		||||
	struct mxs_gpio_port *port = gpiochip_get_data(gc);
 | 
			
		||||
 | 
			
		||||
	return irq_find_mapping(port->domain, offset);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int mxs_gpio_get_direction(struct gpio_chip *gc, unsigned offset)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
	struct mxs_gpio_port *port =
 | 
			
		||||
		container_of(bgc, struct mxs_gpio_port, bgc);
 | 
			
		||||
	struct mxs_gpio_port *port = gpiochip_get_data(gc);
 | 
			
		||||
	u32 mask = 1 << offset;
 | 
			
		||||
	u32 dir;
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -330,26 +327,24 @@ static int mxs_gpio_probe(struct platform_device *pdev)
 | 
			
		|||
	irq_set_chained_handler_and_data(port->irq, mxs_gpio_irq_handler,
 | 
			
		||||
					 port);
 | 
			
		||||
 | 
			
		||||
	err = bgpio_init(&port->bgc, &pdev->dev, 4,
 | 
			
		||||
	err = bgpio_init(&port->gc, &pdev->dev, 4,
 | 
			
		||||
			 port->base + PINCTRL_DIN(port),
 | 
			
		||||
			 port->base + PINCTRL_DOUT(port) + MXS_SET,
 | 
			
		||||
			 port->base + PINCTRL_DOUT(port) + MXS_CLR,
 | 
			
		||||
			 port->base + PINCTRL_DOE(port), NULL, 0);
 | 
			
		||||
	if (err)
 | 
			
		||||
		goto out_irqdesc_free;
 | 
			
		||||
		goto out_irqdomain_remove;
 | 
			
		||||
 | 
			
		||||
	port->bgc.gc.to_irq = mxs_gpio_to_irq;
 | 
			
		||||
	port->bgc.gc.get_direction = mxs_gpio_get_direction;
 | 
			
		||||
	port->bgc.gc.base = port->id * 32;
 | 
			
		||||
	port->gc.to_irq = mxs_gpio_to_irq;
 | 
			
		||||
	port->gc.get_direction = mxs_gpio_get_direction;
 | 
			
		||||
	port->gc.base = port->id * 32;
 | 
			
		||||
 | 
			
		||||
	err = gpiochip_add(&port->bgc.gc);
 | 
			
		||||
	err = gpiochip_add_data(&port->gc, port);
 | 
			
		||||
	if (err)
 | 
			
		||||
		goto out_bgpio_remove;
 | 
			
		||||
		goto out_irqdomain_remove;
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
 | 
			
		||||
out_bgpio_remove:
 | 
			
		||||
	bgpio_remove(&port->bgc);
 | 
			
		||||
out_irqdomain_remove:
 | 
			
		||||
	irq_domain_remove(port->domain);
 | 
			
		||||
out_irqdesc_free:
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -10,7 +10,6 @@
 | 
			
		|||
 */
 | 
			
		||||
 | 
			
		||||
#include <linux/errno.h>
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/init.h>
 | 
			
		||||
#include <linux/io.h>
 | 
			
		||||
#include <linux/irq.h>
 | 
			
		||||
| 
						 | 
				
			
			@ -20,7 +19,7 @@
 | 
			
		|||
#include <linux/pci.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
#include <linux/of_irq.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
 | 
			
		||||
#define DRV_NAME		"sdv_gpio"
 | 
			
		||||
#define SDV_NUM_PUB_GPIOS	12
 | 
			
		||||
| 
						 | 
				
			
			@ -43,7 +42,7 @@ struct sdv_gpio_chip_data {
 | 
			
		|||
	void __iomem *gpio_pub_base;
 | 
			
		||||
	struct irq_domain *id;
 | 
			
		||||
	struct irq_chip_generic *gc;
 | 
			
		||||
	struct bgpio_chip bgpio;
 | 
			
		||||
	struct gpio_chip chip;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static int sdv_gpio_pub_set_type(struct irq_data *d, unsigned int type)
 | 
			
		||||
| 
						 | 
				
			
			@ -226,14 +225,14 @@ static int sdv_gpio_probe(struct pci_dev *pdev,
 | 
			
		|||
		writel(mux_val, sd->gpio_pub_base + GPMUXCTL);
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	ret = bgpio_init(&sd->bgpio, &pdev->dev, 4,
 | 
			
		||||
	ret = bgpio_init(&sd->chip, &pdev->dev, 4,
 | 
			
		||||
			sd->gpio_pub_base + GPINR, sd->gpio_pub_base + GPOUTR,
 | 
			
		||||
			NULL, sd->gpio_pub_base + GPOER, NULL, 0);
 | 
			
		||||
	if (ret)
 | 
			
		||||
		goto unmap;
 | 
			
		||||
	sd->bgpio.gc.ngpio = SDV_NUM_PUB_GPIOS;
 | 
			
		||||
	sd->chip.ngpio = SDV_NUM_PUB_GPIOS;
 | 
			
		||||
 | 
			
		||||
	ret = gpiochip_add(&sd->bgpio.gc);
 | 
			
		||||
	ret = gpiochip_add_data(&sd->chip, sd);
 | 
			
		||||
	if (ret < 0) {
 | 
			
		||||
		dev_err(&pdev->dev, "gpiochip_add() failed.\n");
 | 
			
		||||
		goto unmap;
 | 
			
		||||
| 
						 | 
				
			
			@ -265,7 +264,7 @@ static void sdv_gpio_remove(struct pci_dev *pdev)
 | 
			
		|||
	free_irq(pdev->irq, sd);
 | 
			
		||||
	irq_free_descs(sd->irq_base, SDV_NUM_PUB_GPIOS);
 | 
			
		||||
 | 
			
		||||
	gpiochip_remove(&sd->bgpio.gc);
 | 
			
		||||
	gpiochip_remove(&sd->chip);
 | 
			
		||||
	pci_release_region(pdev, GPIO_BAR);
 | 
			
		||||
	iounmap(sd->gpio_pub_base);
 | 
			
		||||
	pci_disable_device(pdev);
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -23,10 +23,8 @@
 | 
			
		|||
#include <linux/io.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
#include <linux/of_gpio.h>
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
#include <linux/acpi.h>
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
 | 
			
		||||
#include "gpiolib.h"
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -43,38 +41,31 @@
 | 
			
		|||
 | 
			
		||||
/**
 | 
			
		||||
 * struct xgene_gpio_sb - GPIO-Standby private data structure.
 | 
			
		||||
 * @bgc:			memory-mapped GPIO controllers.
 | 
			
		||||
 * @gc:				memory-mapped GPIO controllers.
 | 
			
		||||
 * @irq:			Mapping GPIO pins and interrupt number
 | 
			
		||||
 * nirq:			Number of GPIO pins that supports interrupt
 | 
			
		||||
 */
 | 
			
		||||
struct xgene_gpio_sb {
 | 
			
		||||
	struct bgpio_chip	bgc;
 | 
			
		||||
	struct gpio_chip	gc;
 | 
			
		||||
	u32 *irq;
 | 
			
		||||
	u32 nirq;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static inline struct xgene_gpio_sb *to_xgene_gpio_sb(struct gpio_chip *gc)
 | 
			
		||||
{
 | 
			
		||||
	struct bgpio_chip *bgc = to_bgpio_chip(gc);
 | 
			
		||||
 | 
			
		||||
	return container_of(bgc, struct xgene_gpio_sb, bgc);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void xgene_gpio_set_bit(struct bgpio_chip *bgc, void __iomem *reg, u32 gpio, int val)
 | 
			
		||||
static void xgene_gpio_set_bit(struct gpio_chip *gc, void __iomem *reg, u32 gpio, int val)
 | 
			
		||||
{
 | 
			
		||||
	u32 data;
 | 
			
		||||
 | 
			
		||||
	data = bgc->read_reg(reg);
 | 
			
		||||
	data = gc->read_reg(reg);
 | 
			
		||||
	if (val)
 | 
			
		||||
		data |= GPIO_MASK(gpio);
 | 
			
		||||
	else
 | 
			
		||||
		data &= ~GPIO_MASK(gpio);
 | 
			
		||||
	bgc->write_reg(reg, data);
 | 
			
		||||
	gc->write_reg(reg, data);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int apm_gpio_sb_to_irq(struct gpio_chip *gc, u32 gpio)
 | 
			
		||||
{
 | 
			
		||||
	struct xgene_gpio_sb *priv = to_xgene_gpio_sb(gc);
 | 
			
		||||
	struct xgene_gpio_sb *priv = gpiochip_get_data(gc);
 | 
			
		||||
 | 
			
		||||
	if (priv->irq[gpio])
 | 
			
		||||
		return priv->irq[gpio];
 | 
			
		||||
| 
						 | 
				
			
			@ -99,15 +90,15 @@ static int xgene_gpio_sb_probe(struct platform_device *pdev)
 | 
			
		|||
	if (IS_ERR(regs))
 | 
			
		||||
		return PTR_ERR(regs);
 | 
			
		||||
 | 
			
		||||
	ret = bgpio_init(&priv->bgc, &pdev->dev, 4,
 | 
			
		||||
	ret = bgpio_init(&priv->gc, &pdev->dev, 4,
 | 
			
		||||
			regs + MPA_GPIO_IN_ADDR,
 | 
			
		||||
			regs + MPA_GPIO_OUT_ADDR, NULL,
 | 
			
		||||
			regs + MPA_GPIO_OE_ADDR, NULL, 0);
 | 
			
		||||
        if (ret)
 | 
			
		||||
                return ret;
 | 
			
		||||
 | 
			
		||||
	priv->bgc.gc.to_irq = apm_gpio_sb_to_irq;
 | 
			
		||||
	priv->bgc.gc.ngpio = XGENE_MAX_GPIO_DS;
 | 
			
		||||
	priv->gc.to_irq = apm_gpio_sb_to_irq;
 | 
			
		||||
	priv->gc.ngpio = XGENE_MAX_GPIO_DS;
 | 
			
		||||
 | 
			
		||||
	priv->nirq = XGENE_MAX_GPIO_DS_IRQ;
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -118,14 +109,14 @@ static int xgene_gpio_sb_probe(struct platform_device *pdev)
 | 
			
		|||
 | 
			
		||||
	for (i = 0; i < priv->nirq; i++) {
 | 
			
		||||
		priv->irq[default_lines[i]] = platform_get_irq(pdev, i);
 | 
			
		||||
		xgene_gpio_set_bit(&priv->bgc, regs + MPA_GPIO_SEL_LO,
 | 
			
		||||
		xgene_gpio_set_bit(&priv->gc, regs + MPA_GPIO_SEL_LO,
 | 
			
		||||
                                   default_lines[i] * 2, 1);
 | 
			
		||||
		xgene_gpio_set_bit(&priv->bgc, regs + MPA_GPIO_INT_LVL, i, 1);
 | 
			
		||||
		xgene_gpio_set_bit(&priv->gc, regs + MPA_GPIO_INT_LVL, i, 1);
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	platform_set_drvdata(pdev, priv);
 | 
			
		||||
 | 
			
		||||
	ret = gpiochip_add(&priv->bgc.gc);
 | 
			
		||||
	ret = gpiochip_add_data(&priv->gc, priv);
 | 
			
		||||
	if (ret)
 | 
			
		||||
		dev_err(&pdev->dev, "failed to register X-Gene GPIO Standby driver\n");
 | 
			
		||||
	else
 | 
			
		||||
| 
						 | 
				
			
			@ -133,7 +124,7 @@ static int xgene_gpio_sb_probe(struct platform_device *pdev)
 | 
			
		|||
 | 
			
		||||
	if (priv->nirq > 0) {
 | 
			
		||||
		/* Register interrupt handlers for gpio signaled acpi events */
 | 
			
		||||
		acpi_gpiochip_request_interrupts(&priv->bgc.gc);
 | 
			
		||||
		acpi_gpiochip_request_interrupts(&priv->gc);
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return ret;
 | 
			
		||||
| 
						 | 
				
			
			@ -144,10 +135,11 @@ static int xgene_gpio_sb_remove(struct platform_device *pdev)
 | 
			
		|||
	struct xgene_gpio_sb *priv = platform_get_drvdata(pdev);
 | 
			
		||||
 | 
			
		||||
	if (priv->nirq > 0) {
 | 
			
		||||
		acpi_gpiochip_free_interrupts(&priv->bgc.gc);
 | 
			
		||||
		acpi_gpiochip_free_interrupts(&priv->gc);
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return bgpio_remove(&priv->bgc);
 | 
			
		||||
	gpiochip_remove(&priv->gc);
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static const struct of_device_id xgene_gpio_sb_of_match[] = {
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -11,7 +11,7 @@
 | 
			
		|||
 * Copyright (C) 2012 ARM Limited
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
#include <linux/basic_mmio_gpio.h>
 | 
			
		||||
#include <linux/gpio/driver.h>
 | 
			
		||||
#include <linux/err.h>
 | 
			
		||||
#include <linux/io.h>
 | 
			
		||||
#include <linux/mfd/core.h>
 | 
			
		||||
| 
						 | 
				
			
			@ -164,7 +164,7 @@ static int vexpress_sysreg_probe(struct platform_device *pdev)
 | 
			
		|||
{
 | 
			
		||||
	struct resource *mem;
 | 
			
		||||
	void __iomem *base;
 | 
			
		||||
	struct bgpio_chip *mmc_gpio_chip;
 | 
			
		||||
	struct gpio_chip *mmc_gpio_chip;
 | 
			
		||||
	int master;
 | 
			
		||||
	u32 dt_hbi;
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -201,8 +201,8 @@ static int vexpress_sysreg_probe(struct platform_device *pdev)
 | 
			
		|||
		return -ENOMEM;
 | 
			
		||||
	bgpio_init(mmc_gpio_chip, &pdev->dev, 0x4, base + SYS_MCI,
 | 
			
		||||
			NULL, NULL, NULL, NULL, 0);
 | 
			
		||||
	mmc_gpio_chip->gc.ngpio = 2;
 | 
			
		||||
	gpiochip_add(&mmc_gpio_chip->gc);
 | 
			
		||||
	mmc_gpio_chip->ngpio = 2;
 | 
			
		||||
	gpiochip_add(mmc_gpio_chip);
 | 
			
		||||
 | 
			
		||||
	return mfd_add_devices(&pdev->dev, PLATFORM_DEVID_AUTO,
 | 
			
		||||
			vexpress_sysreg_cells,
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -1,80 +0,0 @@
 | 
			
		|||
/*
 | 
			
		||||
 * Basic memory-mapped GPIO controllers.
 | 
			
		||||
 *
 | 
			
		||||
 * Copyright 2008 MontaVista Software, Inc.
 | 
			
		||||
 * Copyright 2008,2010 Anton Vorontsov <cbouatmailru@gmail.com>
 | 
			
		||||
 *
 | 
			
		||||
 * 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.
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
#ifndef __BASIC_MMIO_GPIO_H
 | 
			
		||||
#define __BASIC_MMIO_GPIO_H
 | 
			
		||||
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/types.h>
 | 
			
		||||
#include <linux/compiler.h>
 | 
			
		||||
#include <linux/spinlock_types.h>
 | 
			
		||||
 | 
			
		||||
struct bgpio_pdata {
 | 
			
		||||
	const char *label;
 | 
			
		||||
	int base;
 | 
			
		||||
	int ngpio;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
struct device;
 | 
			
		||||
 | 
			
		||||
struct bgpio_chip {
 | 
			
		||||
	struct gpio_chip gc;
 | 
			
		||||
 | 
			
		||||
	unsigned long (*read_reg)(void __iomem *reg);
 | 
			
		||||
	void (*write_reg)(void __iomem *reg, unsigned long data);
 | 
			
		||||
 | 
			
		||||
	void __iomem *reg_dat;
 | 
			
		||||
	void __iomem *reg_set;
 | 
			
		||||
	void __iomem *reg_clr;
 | 
			
		||||
	void __iomem *reg_dir;
 | 
			
		||||
 | 
			
		||||
	/* Number of bits (GPIOs): <register width> * 8. */
 | 
			
		||||
	int bits;
 | 
			
		||||
 | 
			
		||||
	/*
 | 
			
		||||
	 * Some GPIO controllers work with the big-endian bits notation,
 | 
			
		||||
	 * e.g. in a 8-bits register, GPIO7 is the least significant bit.
 | 
			
		||||
	 */
 | 
			
		||||
	unsigned long (*pin2mask)(struct bgpio_chip *bgc, unsigned int pin);
 | 
			
		||||
 | 
			
		||||
	/*
 | 
			
		||||
	 * Used to lock bgpio_chip->data. Also, this is needed to keep
 | 
			
		||||
	 * shadowed and real data registers writes together.
 | 
			
		||||
	 */
 | 
			
		||||
	spinlock_t lock;
 | 
			
		||||
 | 
			
		||||
	/* Shadowed data register to clear/set bits safely. */
 | 
			
		||||
	unsigned long data;
 | 
			
		||||
 | 
			
		||||
	/* Shadowed direction registers to clear/set direction safely. */
 | 
			
		||||
	unsigned long dir;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static inline struct bgpio_chip *to_bgpio_chip(struct gpio_chip *gc)
 | 
			
		||||
{
 | 
			
		||||
	return container_of(gc, struct bgpio_chip, gc);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int bgpio_remove(struct bgpio_chip *bgc);
 | 
			
		||||
int bgpio_init(struct bgpio_chip *bgc, struct device *dev,
 | 
			
		||||
	       unsigned long sz, void __iomem *dat, void __iomem *set,
 | 
			
		||||
	       void __iomem *clr, void __iomem *dirout, void __iomem *dirin,
 | 
			
		||||
	       unsigned long flags);
 | 
			
		||||
 | 
			
		||||
#define BGPIOF_BIG_ENDIAN		BIT(0)
 | 
			
		||||
#define BGPIOF_UNREADABLE_REG_SET	BIT(1) /* reg_set is unreadable */
 | 
			
		||||
#define BGPIOF_UNREADABLE_REG_DIR	BIT(2) /* reg_dir is unreadable */
 | 
			
		||||
#define BGPIOF_BIG_ENDIAN_BYTE_ORDER	BIT(3)
 | 
			
		||||
#define BGPIOF_READ_OUTPUT_REG_SET     BIT(4) /* reg_set stores output value */
 | 
			
		||||
#define BGPIOF_NO_OUTPUT		BIT(5) /* only input */
 | 
			
		||||
 | 
			
		||||
#endif /* __BASIC_MMIO_GPIO_H */
 | 
			
		||||
| 
						 | 
				
			
			@ -8,6 +8,7 @@
 | 
			
		|||
#include <linux/irqdomain.h>
 | 
			
		||||
#include <linux/lockdep.h>
 | 
			
		||||
#include <linux/pinctrl/pinctrl.h>
 | 
			
		||||
#include <linux/kconfig.h>
 | 
			
		||||
 | 
			
		||||
struct device;
 | 
			
		||||
struct gpio_desc;
 | 
			
		||||
| 
						 | 
				
			
			@ -65,6 +66,23 @@ struct seq_file;
 | 
			
		|||
 *	registers.
 | 
			
		||||
 * @irq_not_threaded: flag must be set if @can_sleep is set but the
 | 
			
		||||
 *	IRQs don't need to be threaded
 | 
			
		||||
 * @read_reg: reader function for generic GPIO
 | 
			
		||||
 * @write_reg: writer function for generic GPIO
 | 
			
		||||
 * @pin2mask: some generic GPIO controllers work with the big-endian bits
 | 
			
		||||
 *	notation, e.g. in a 8-bits register, GPIO7 is the least significant
 | 
			
		||||
 *	bit. This callback assigns the right bit mask.
 | 
			
		||||
 * @reg_dat: data (in) register for generic GPIO
 | 
			
		||||
 * @reg_set: output set register (out=high) for generic GPIO
 | 
			
		||||
 * @reg_clk: output clear register (out=low) for generic GPIO
 | 
			
		||||
 * @reg_dir: direction setting register for generic GPIO
 | 
			
		||||
 * @bgpio_bits: number of register bits used for a generic GPIO i.e.
 | 
			
		||||
 *	<register width> * 8
 | 
			
		||||
 * @bgpio_lock: used to lock chip->bgpio_data. Also, this is needed to keep
 | 
			
		||||
 *	shadowed and real data registers writes together.
 | 
			
		||||
 * @bgpio_data:	shadowed data register for generic GPIO to clear/set bits
 | 
			
		||||
 *	safely.
 | 
			
		||||
 * @bgpio_dir: shadowed direction register for generic GPIO to clear/set
 | 
			
		||||
 *	direction safely.
 | 
			
		||||
 * @irqchip: GPIO IRQ chip impl, provided by GPIO driver
 | 
			
		||||
 * @irqdomain: Interrupt translation domain; responsible for mapping
 | 
			
		||||
 *	between GPIO hwirq number and linux irq number
 | 
			
		||||
| 
						 | 
				
			
			@ -128,6 +146,20 @@ struct gpio_chip {
 | 
			
		|||
	bool			can_sleep;
 | 
			
		||||
	bool			irq_not_threaded;
 | 
			
		||||
 | 
			
		||||
#if IS_ENABLED(CONFIG_GPIO_GENERIC)
 | 
			
		||||
	unsigned long (*read_reg)(void __iomem *reg);
 | 
			
		||||
	void (*write_reg)(void __iomem *reg, unsigned long data);
 | 
			
		||||
	unsigned long (*pin2mask)(struct gpio_chip *gc, unsigned int pin);
 | 
			
		||||
	void __iomem *reg_dat;
 | 
			
		||||
	void __iomem *reg_set;
 | 
			
		||||
	void __iomem *reg_clr;
 | 
			
		||||
	void __iomem *reg_dir;
 | 
			
		||||
	int bgpio_bits;
 | 
			
		||||
	spinlock_t bgpio_lock;
 | 
			
		||||
	unsigned long bgpio_data;
 | 
			
		||||
	unsigned long bgpio_dir;
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
#ifdef CONFIG_GPIOLIB_IRQCHIP
 | 
			
		||||
	/*
 | 
			
		||||
	 * With CONFIG_GPIOLIB_IRQCHIP we get an irqchip inside the gpiolib
 | 
			
		||||
| 
						 | 
				
			
			@ -188,6 +220,28 @@ static inline void *gpiochip_get_data(struct gpio_chip *chip)
 | 
			
		|||
 | 
			
		||||
struct gpio_chip *gpiod_to_chip(const struct gpio_desc *desc);
 | 
			
		||||
 | 
			
		||||
#if IS_ENABLED(CONFIG_GPIO_GENERIC)
 | 
			
		||||
 | 
			
		||||
struct bgpio_pdata {
 | 
			
		||||
	const char *label;
 | 
			
		||||
	int base;
 | 
			
		||||
	int ngpio;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
int bgpio_init(struct gpio_chip *gc, struct device *dev,
 | 
			
		||||
	       unsigned long sz, void __iomem *dat, void __iomem *set,
 | 
			
		||||
	       void __iomem *clr, void __iomem *dirout, void __iomem *dirin,
 | 
			
		||||
	       unsigned long flags);
 | 
			
		||||
 | 
			
		||||
#define BGPIOF_BIG_ENDIAN		BIT(0)
 | 
			
		||||
#define BGPIOF_UNREADABLE_REG_SET	BIT(1) /* reg_set is unreadable */
 | 
			
		||||
#define BGPIOF_UNREADABLE_REG_DIR	BIT(2) /* reg_dir is unreadable */
 | 
			
		||||
#define BGPIOF_BIG_ENDIAN_BYTE_ORDER	BIT(3)
 | 
			
		||||
#define BGPIOF_READ_OUTPUT_REG_SET	BIT(4) /* reg_set stores output value */
 | 
			
		||||
#define BGPIOF_NO_OUTPUT		BIT(5) /* only input */
 | 
			
		||||
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
#ifdef CONFIG_GPIOLIB_IRQCHIP
 | 
			
		||||
 | 
			
		||||
void gpiochip_set_chained_irqchip(struct gpio_chip *gpiochip,
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
		Loading…
	
		Reference in a new issue