Commit 0f4630f3 authored by Linus Walleij's avatar Linus Walleij

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: default avatarGregory Fong <gregory.0xf0@gmail.com>
Acked-by: default avatarLiviu Dudau <Liviu.Dudau@arm.com>
Acked-by: default avatarH Hartley Sweeten <hsweeten@visionengravers.com>
Acked-by: default avatarTony Lindgren <tony@atomide.com>
Acked-by: default avatarKrzysztof Kozlowski <k.kozlowski@samsung.com>
Acked-by: default avatarLee Jones <lee.jones@linaro.org>
Signed-off-by: default avatarLinus Walleij <linus.walleij@linaro.org>
parent 3208b0f0
...@@ -31,7 +31,7 @@ ...@@ -31,7 +31,7 @@
#include <linux/mtd/partitions.h> #include <linux/mtd/partitions.h>
#include <linux/mtd/nand-gpio.h> #include <linux/mtd/nand-gpio.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/basic_mmio_gpio.h> #include <linux/gpio/driver.h>
#include <mach/hardware.h> #include <mach/hardware.h>
#include <asm/sizes.h> #include <asm/sizes.h>
......
...@@ -28,7 +28,7 @@ ...@@ -28,7 +28,7 @@
#include <linux/leds.h> #include <linux/leds.h>
#include <linux/sizes.h> #include <linux/sizes.h>
#include <linux/backlight.h> #include <linux/backlight.h>
#include <linux/basic_mmio_gpio.h> #include <linux/gpio/driver.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/mtd/partitions.h> #include <linux/mtd/partitions.h>
#include <linux/mtd/nand-gpio.h> #include <linux/mtd/nand-gpio.h>
......
...@@ -17,7 +17,7 @@ ...@@ -17,7 +17,7 @@
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/mtd/mtd.h> #include <linux/mtd/mtd.h>
#include <linux/mtd/physmap.h> #include <linux/mtd/physmap.h>
#include <linux/basic_mmio_gpio.h> #include <linux/gpio/driver.h>
#include <linux/gpio.h> #include <linux/gpio.h>
#include <linux/regulator/fixed.h> #include <linux/regulator/fixed.h>
#include <linux/regulator/machine.h> #include <linux/regulator/machine.h>
......
...@@ -11,7 +11,7 @@ ...@@ -11,7 +11,7 @@
* it under the terms of the GNU General Public License version 2 as * it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation. * published by the Free Software Foundation.
*/ */
#include <linux/basic_mmio_gpio.h> #include <linux/gpio/driver.h>
#include <linux/gpio.h> #include <linux/gpio.h>
#include <linux/kernel.h> #include <linux/kernel.h>
#include <linux/init.h> #include <linux/init.h>
......
...@@ -29,7 +29,7 @@ ...@@ -29,7 +29,7 @@
#include <linux/pwm_backlight.h> #include <linux/pwm_backlight.h>
#include <linux/dm9000.h> #include <linux/dm9000.h>
#include <linux/gpio_keys.h> #include <linux/gpio_keys.h>
#include <linux/basic_mmio_gpio.h> #include <linux/gpio/driver.h>
#include <linux/spi/spi.h> #include <linux/spi/spi.h>
#include <linux/platform_data/pca953x.h> #include <linux/platform_data/pca953x.h>
......
...@@ -10,10 +10,9 @@ ...@@ -10,10 +10,9 @@
*/ */
#include <linux/err.h> #include <linux/err.h>
#include <linux/gpio.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/of_device.h> #include <linux/of_device.h>
#include <linux/basic_mmio_gpio.h> #include <linux/gpio/driver.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#define MMIO_74XX_DIR_IN (0 << 8) #define MMIO_74XX_DIR_IN (0 << 8)
...@@ -21,7 +20,7 @@ ...@@ -21,7 +20,7 @@
#define MMIO_74XX_BIT_CNT(x) ((x) & 0xff) #define MMIO_74XX_BIT_CNT(x) ((x) & 0xff)
struct mmio_74xx_gpio_priv { struct mmio_74xx_gpio_priv {
struct bgpio_chip bgc; struct gpio_chip gc;
unsigned flags; unsigned flags;
}; };
...@@ -78,30 +77,23 @@ static const struct of_device_id mmio_74xx_gpio_ids[] = { ...@@ -78,30 +77,23 @@ static const struct of_device_id mmio_74xx_gpio_ids[] = {
}; };
MODULE_DEVICE_TABLE(of, 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) 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) 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; return (priv->flags & MMIO_74XX_DIR_OUT) ? -ENOTSUPP : 0;
} }
static int mmio_74xx_dir_out(struct gpio_chip *gc, unsigned int gpio, int val) 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) { if (priv->flags & MMIO_74XX_DIR_OUT) {
gc->set(gc, gpio, val); gc->set(gc, gpio, val);
...@@ -134,28 +126,29 @@ static int mmio_74xx_gpio_probe(struct platform_device *pdev) ...@@ -134,28 +126,29 @@ static int mmio_74xx_gpio_probe(struct platform_device *pdev)
priv->flags = (uintptr_t) of_id->data; 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), DIV_ROUND_UP(MMIO_74XX_BIT_CNT(priv->flags), 8),
dat, NULL, NULL, NULL, NULL, 0); dat, NULL, NULL, NULL, NULL, 0);
if (err) if (err)
return err; return err;
priv->bgc.gc.direction_input = mmio_74xx_dir_in; priv->gc.direction_input = mmio_74xx_dir_in;
priv->bgc.gc.direction_output = mmio_74xx_dir_out; priv->gc.direction_output = mmio_74xx_dir_out;
priv->bgc.gc.get_direction = mmio_74xx_get_direction; priv->gc.get_direction = mmio_74xx_get_direction;
priv->bgc.gc.ngpio = MMIO_74XX_BIT_CNT(priv->flags); priv->gc.ngpio = MMIO_74XX_BIT_CNT(priv->flags);
priv->bgc.gc.owner = THIS_MODULE; priv->gc.owner = THIS_MODULE;
platform_set_drvdata(pdev, priv); 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) static int mmio_74xx_gpio_remove(struct platform_device *pdev)
{ {
struct mmio_74xx_gpio_priv *priv = platform_get_drvdata(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 = { static struct platform_driver mmio_74xx_gpio_driver = {
......
...@@ -16,7 +16,6 @@ ...@@ -16,7 +16,6 @@
#include <linux/of_device.h> #include <linux/of_device.h>
#include <linux/of_irq.h> #include <linux/of_irq.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/basic_mmio_gpio.h>
#include <linux/irqdomain.h> #include <linux/irqdomain.h>
#include <linux/irqchip/chained_irq.h> #include <linux/irqchip/chained_irq.h>
#include <linux/interrupt.h> #include <linux/interrupt.h>
...@@ -35,7 +34,7 @@ ...@@ -35,7 +34,7 @@
struct brcmstb_gpio_bank { struct brcmstb_gpio_bank {
struct list_head node; struct list_head node;
int id; int id;
struct bgpio_chip bgc; struct gpio_chip gc;
struct brcmstb_gpio_priv *parent_priv; struct brcmstb_gpio_priv *parent_priv;
u32 width; u32 width;
struct irq_chip irq_chip; struct irq_chip irq_chip;
...@@ -57,37 +56,30 @@ struct brcmstb_gpio_priv { ...@@ -57,37 +56,30 @@ struct brcmstb_gpio_priv {
/* assumes MAX_GPIO_PER_BANK is a multiple of 2 */ /* assumes MAX_GPIO_PER_BANK is a multiple of 2 */
#define GPIO_BIT(gpio) ((gpio) & (MAX_GPIO_PER_BANK - 1)) #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 * static inline struct brcmstb_gpio_priv *
brcmstb_gpio_gc_to_priv(struct gpio_chip *gc) 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; return bank->parent_priv;
} }
static void brcmstb_gpio_set_imask(struct brcmstb_gpio_bank *bank, static void brcmstb_gpio_set_imask(struct brcmstb_gpio_bank *bank,
unsigned int offset, bool enable) 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; struct brcmstb_gpio_priv *priv = bank->parent_priv;
u32 mask = bgc->pin2mask(bgc, offset); u32 mask = gc->pin2mask(gc, offset);
u32 imask; u32 imask;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&bgc->lock, flags); spin_lock_irqsave(&gc->bgpio_lock, flags);
imask = bgc->read_reg(priv->reg_base + GIO_MASK(bank->id)); imask = gc->read_reg(priv->reg_base + GIO_MASK(bank->id));
if (enable) if (enable)
imask |= mask; imask |= mask;
else else
imask &= ~mask; imask &= ~mask;
bgc->write_reg(priv->reg_base + GIO_MASK(bank->id), imask); gc->write_reg(priv->reg_base + GIO_MASK(bank->id), imask);
spin_unlock_irqrestore(&bgc->lock, flags); spin_unlock_irqrestore(&gc->bgpio_lock, flags);
} }
/* -------------------- IRQ chip functions -------------------- */ /* -------------------- IRQ chip functions -------------------- */
...@@ -95,7 +87,7 @@ static void brcmstb_gpio_set_imask(struct brcmstb_gpio_bank *bank, ...@@ -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) static void brcmstb_gpio_irq_mask(struct irq_data *d)
{ {
struct gpio_chip *gc = irq_data_get_irq_chip_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); brcmstb_gpio_set_imask(bank, d->hwirq, false);
} }
...@@ -103,7 +95,7 @@ static void brcmstb_gpio_irq_mask(struct irq_data *d) ...@@ -103,7 +95,7 @@ static void brcmstb_gpio_irq_mask(struct irq_data *d)
static void brcmstb_gpio_irq_unmask(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 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); brcmstb_gpio_set_imask(bank, d->hwirq, true);
} }
...@@ -111,7 +103,7 @@ static void brcmstb_gpio_irq_unmask(struct irq_data *d) ...@@ -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) 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 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; struct brcmstb_gpio_priv *priv = bank->parent_priv;
u32 mask = BIT(d->hwirq); u32 mask = BIT(d->hwirq);
u32 edge_insensitive, iedge_insensitive; u32 edge_insensitive, iedge_insensitive;
...@@ -149,23 +141,23 @@ static int brcmstb_gpio_irq_set_type(struct irq_data *d, unsigned int type) ...@@ -149,23 +141,23 @@ static int brcmstb_gpio_irq_set_type(struct irq_data *d, unsigned int type)
return -EINVAL; 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; 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; 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; 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); 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); 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); ilevel | level);
spin_unlock_irqrestore(&bank->bgc.lock, flags); spin_unlock_irqrestore(&bank->gc.bgpio_lock, flags);
return 0; return 0;
} }
...@@ -210,29 +202,29 @@ static irqreturn_t brcmstb_gpio_wake_irq_handler(int irq, void *data) ...@@ -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) static void brcmstb_gpio_irq_bank_handler(struct brcmstb_gpio_bank *bank)
{ {
struct brcmstb_gpio_priv *priv = bank->parent_priv; 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; void __iomem *reg_base = priv->reg_base;
unsigned long status; unsigned long status;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&bank->bgc.lock, flags); spin_lock_irqsave(&bank->gc.bgpio_lock, flags);
while ((status = bank->bgc.read_reg(reg_base + GIO_STAT(bank->id)) & while ((status = bank->gc.read_reg(reg_base + GIO_STAT(bank->id)) &
bank->bgc.read_reg(reg_base + GIO_MASK(bank->id)))) { bank->gc.read_reg(reg_base + GIO_MASK(bank->id)))) {
int bit; int bit;
for_each_set_bit(bit, &status, 32) { 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)); GIO_STAT(bank->id));
if (bit >= bank->width) if (bit >= bank->width)
dev_warn(&priv->pdev->dev, dev_warn(&priv->pdev->dev,
"IRQ for invalid GPIO (bank=%d, offset=%d)\n", "IRQ for invalid GPIO (bank=%d, offset=%d)\n",
bank->id, bit); 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)); stat | BIT(bit));
generic_handle_irq(irq_find_mapping(irq_domain, 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 */ /* Each UPG GIO block has one IRQ for all banks */
...@@ -303,9 +295,7 @@ static int brcmstb_gpio_remove(struct platform_device *pdev) ...@@ -303,9 +295,7 @@ static int brcmstb_gpio_remove(struct platform_device *pdev)
*/ */
list_for_each(pos, &priv->bank_list) { list_for_each(pos, &priv->bank_list) {
bank = list_entry(pos, struct brcmstb_gpio_bank, node); bank = list_entry(pos, struct brcmstb_gpio_bank, node);
ret = bgpio_remove(&bank->bgc); gpiochip_remove(&bank->gc);
if (ret)
dev_err(&pdev->dev, "gpiochip_remove fail in cleanup\n");
} }
if (priv->reboot_notifier.notifier_call) { if (priv->reboot_notifier.notifier_call) {
ret = unregister_reboot_notifier(&priv->reboot_notifier); ret = unregister_reboot_notifier(&priv->reboot_notifier);
...@@ -320,7 +310,7 @@ static int brcmstb_gpio_of_xlate(struct gpio_chip *gc, ...@@ -320,7 +310,7 @@ static int brcmstb_gpio_of_xlate(struct gpio_chip *gc,
const struct of_phandle_args *gpiospec, u32 *flags) const struct of_phandle_args *gpiospec, u32 *flags)
{ {
struct brcmstb_gpio_priv *priv = brcmstb_gpio_gc_to_priv(gc); 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; int offset;
if (gc->of_gpio_n_cells != 2) { if (gc->of_gpio_n_cells != 2) {
...@@ -398,9 +388,9 @@ static int brcmstb_gpio_irq_setup(struct platform_device *pdev, ...@@ -398,9 +388,9 @@ static int brcmstb_gpio_irq_setup(struct platform_device *pdev,
if (priv->can_wake) if (priv->can_wake)
bank->irq_chip.irq_set_wake = brcmstb_gpio_irq_set_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); 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); priv->parent_irq, brcmstb_gpio_irq_handler);
return 0; return 0;
...@@ -451,7 +441,6 @@ static int brcmstb_gpio_probe(struct platform_device *pdev) ...@@ -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, of_property_for_each_u32(np, "brcm,gpio-bank-widths", prop, p,
bank_width) { bank_width) {
struct brcmstb_gpio_bank *bank; struct brcmstb_gpio_bank *bank;
struct bgpio_chip *bgc;
struct gpio_chip *gc; struct gpio_chip *gc;
bank = devm_kzalloc(dev, sizeof(*bank), GFP_KERNEL); bank = devm_kzalloc(dev, sizeof(*bank), GFP_KERNEL);
...@@ -473,8 +462,8 @@ static int brcmstb_gpio_probe(struct platform_device *pdev) ...@@ -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, * Regs are 4 bytes wide, have data reg, no set/clear regs,
* and direction bits have 0 = output and 1 = input * and direction bits have 0 = output and 1 = input
*/ */
bgc = &bank->bgc; gc = &bank->gc;
err = bgpio_init(bgc, dev, 4, err = bgpio_init(gc, dev, 4,
reg_base + GIO_DATA(bank->id), reg_base + GIO_DATA(bank->id),
NULL, NULL, NULL, NULL, NULL, NULL,
reg_base + GIO_IODIR(bank->id), 0); reg_base + GIO_IODIR(bank->id), 0);
...@@ -483,7 +472,6 @@ static int brcmstb_gpio_probe(struct platform_device *pdev) ...@@ -483,7 +472,6 @@ static int brcmstb_gpio_probe(struct platform_device *pdev)
goto fail; goto fail;
} }
gc = &bgc->gc;
gc->of_node = np; gc->of_node = np;
gc->owner = THIS_MODULE; gc->owner = THIS_MODULE;
gc->label = np->full_name; gc->label = np->full_name;
...@@ -497,9 +485,9 @@ static int brcmstb_gpio_probe(struct platform_device *pdev) ...@@ -497,9 +485,9 @@ static int brcmstb_gpio_probe(struct platform_device *pdev)
* Mask all interrupts by default, since wakeup interrupts may * Mask all interrupts by default, since wakeup interrupts may
* be retained from S5 cold boot * 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) { if (err) {
dev_err(dev, "Could not add gpiochip for bank %d\n", dev_err(dev, "Could not add gpiochip for bank %d\n",
bank->id); bank->id);
......
...@@ -10,24 +10,23 @@ ...@@ -10,24 +10,23 @@
*/ */
#include <linux/err.h> #include <linux/err.h>
#include <linux/gpio.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/basic_mmio_gpio.h> #include <linux/gpio/driver.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
static int clps711x_gpio_probe(struct platform_device *pdev) static int clps711x_gpio_probe(struct platform_device *pdev)
{ {
struct device_node *np = pdev->dev.of_node; struct device_node *np = pdev->dev.of_node;
void __iomem *dat, *dir; void __iomem *dat, *dir;
struct bgpio_chip *bgc; struct gpio_chip *gc;
struct resource *res; struct resource *res;
int err, id = np ? of_alias_get_id(np, "gpio") : pdev->id; int err, id = np ? of_alias_get_id(np, "gpio") : pdev->id;
if ((id < 0) || (id > 4)) if ((id < 0) || (id > 4))
return -ENODEV; return -ENODEV;
bgc = devm_kzalloc(&pdev->dev, sizeof(*bgc), GFP_KERNEL); gc = devm_kzalloc(&pdev->dev, sizeof(*gc), GFP_KERNEL);
if (!bgc) if (!gc)
return -ENOMEM; return -ENOMEM;
res = platform_get_resource(pdev, IORESOURCE_MEM, 0); res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
...@@ -43,11 +42,11 @@ static int clps711x_gpio_probe(struct platform_device *pdev) ...@@ -43,11 +42,11 @@ static int clps711x_gpio_probe(struct platform_device *pdev)
switch (id) { switch (id) {
case 3: case 3:
/* PORTD is inverted logic for direction register */ /* 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); NULL, dir, 0);
break; break;
default: default:
err = bgpio_init(bgc, &pdev->dev, 1, dat, NULL, NULL, err = bgpio_init(gc, &pdev->dev, 1, dat, NULL, NULL,
dir, NULL, 0); dir, NULL, 0);
break; break;
} }
...@@ -58,24 +57,25 @@ static int clps711x_gpio_probe(struct platform_device *pdev) ...@@ -58,24 +57,25 @@ static int clps711x_gpio_probe(struct platform_device *pdev)
switch (id) { switch (id) {
case 4: case 4:
/* PORTE is 3 lines only */ /* PORTE is 3 lines only */
bgc->gc.ngpio = 3; gc->ngpio = 3;
break; break;
default: default:
break; break;
} }
bgc->gc.base = id * 8; gc->base = id * 8;
bgc->gc.owner = THIS_MODULE; gc->owner = THIS_MODULE;
platform_set_drvdata(pdev, bgc); 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) 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[] = { static const struct of_device_id __maybe_unused clps711x_gpio_ids[] = {
......
...@@ -7,7 +7,9 @@ ...@@ -7,7 +7,9 @@
* *
* All enquiries to support@picochip.com * 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/err.h>
#include <linux/init.h> #include <linux/init.h>
#include <linux/interrupt.h> #include <linux/interrupt.h>
...@@ -66,7 +68,7 @@ struct dwapb_context { ...@@ -66,7 +68,7 @@ struct dwapb_context {
#endif #endif
struct dwapb_gpio_port { struct dwapb_gpio_port {
struct bgpio_chip bgc; struct gpio_chip gc;
bool is_registered; bool is_registered;
struct dwapb_gpio *gpio; struct dwapb_gpio *gpio;
#ifdef CONFIG_PM_SLEEP #ifdef CONFIG_PM_SLEEP
...@@ -83,33 +85,26 @@ struct dwapb_gpio { ...@@ -83,33 +85,26 @@ struct dwapb_gpio {
struct irq_domain *domain; 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) 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; 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, static inline void dwapb_write(struct dwapb_gpio *gpio, unsigned int offset,
u32 val) u32 val)
{ {
struct bgpio_chip *bgc = &gpio->ports[0].bgc; struct gpio_chip *gc = &gpio->ports[0].gc;
void __iomem *reg_base = gpio->regs; 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) 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 = gpiochip_get_data(gc);
struct dwapb_gpio_port *port = to_dwapb_gpio_port(bgc);
struct dwapb_gpio *gpio = port->gpio; struct dwapb_gpio *gpio = port->gpio;
return irq_find_mapping(gpio->domain, offset); return irq_find_mapping(gpio->domain, offset);
...@@ -119,7 +114,7 @@ static void dwapb_toggle_trigger(struct dwapb_gpio *gpio, unsigned int offs) ...@@ -119,7 +114,7 @@ static void dwapb_toggle_trigger(struct dwapb_gpio *gpio, unsigned int offs)
{ {
u32 v = dwapb_read(gpio, GPIO_INT_POLARITY); 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); v &= ~BIT(offs);
else else
v |= BIT(offs); v |= BIT(offs);
...@@ -162,39 +157,39 @@ static void dwapb_irq_enable(struct irq_data *d) ...@@ -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 irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
struct dwapb_gpio *gpio = igc->private; 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; unsigned long flags;
u32 val; u32 val;
spin_lock_irqsave(&bgc->lock, flags); spin_lock_irqsave(&gc->bgpio_lock, flags);
val = dwapb_read(gpio, GPIO_INTEN); val = dwapb_read(gpio, GPIO_INTEN);
val |= BIT(d->hwirq); val |= BIT(d->hwirq);
dwapb_write(gpio, GPIO_INTEN, val); 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) static void dwapb_irq_disable(struct irq_data *d)
{ {
struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d); struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
struct dwapb_gpio *gpio = igc->private; 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; unsigned long flags;
u32 val; u32 val;
spin_lock_irqsave(&bgc->lock, flags); spin_lock_irqsave(&gc->bgpio_lock, flags);
val = dwapb_read(gpio, GPIO_INTEN); val = dwapb_read(gpio, GPIO_INTEN);
val &= ~BIT(d->hwirq); val &= ~BIT(d->hwirq);
dwapb_write(gpio, GPIO_INTEN, val); 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) static int dwapb_irq_reqres(struct irq_data *d)
{ {
struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d); struct irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
struct dwapb_gpio *gpio = igc->private; 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", dev_err(gpio->dev, "unable to lock HW IRQ %lu for IRQ\n",
irqd_to_hwirq(d)); irqd_to_hwirq(d));
return -EINVAL; return -EINVAL;
...@@ -206,16 +201,16 @@ static void dwapb_irq_relres(struct irq_data *d) ...@@ -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 irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
struct dwapb_gpio *gpio = igc->private; 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) 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 irq_chip_generic *igc = irq_data_get_irq_chip_data(d);
struct dwapb_gpio *gpio = igc->private; 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; int bit = d->hwirq;
unsigned long level, polarity, flags; unsigned long level, polarity, flags;
...@@ -223,7 +218,7 @@ static int dwapb_irq_set_type(struct irq_data *d, u32 type) ...@@ -223,7 +218,7 @@ static int dwapb_irq_set_type(struct irq_data *d, u32 type)
IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW)) IRQ_TYPE_LEVEL_HIGH | IRQ_TYPE_LEVEL_LOW))
return -EINVAL; return -EINVAL;
spin_lock_irqsave(&bgc->lock, flags); spin_lock_irqsave(&gc->bgpio_lock, flags);
level = dwapb_read(gpio, GPIO_INTTYPE_LEVEL); level = dwapb_read(gpio, GPIO_INTTYPE_LEVEL);
polarity = dwapb_read(gpio, GPIO_INT_POLARITY); polarity = dwapb_read(gpio, GPIO_INT_POLARITY);
...@@ -254,7 +249,7 @@ static int dwapb_irq_set_type(struct irq_data *d, u32 type) ...@@ -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_INTTYPE_LEVEL, level);
dwapb_write(gpio, GPIO_INT_POLARITY, polarity); dwapb_write(gpio, GPIO_INT_POLARITY, polarity);
spin_unlock_irqrestore(&bgc->lock, flags); spin_unlock_irqrestore(&gc->bgpio_lock, flags);
return 0; return 0;
} }
...@@ -262,13 +257,12 @@ static int dwapb_irq_set_type(struct irq_data *d, u32 type) ...@@ -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, static int dwapb_gpio_set_debounce(struct gpio_chip *gc,
unsigned offset, unsigned debounce) unsigned offset, unsigned debounce)
{ {
struct bgpio_chip *bgc = to_bgpio_chip(gc); struct dwapb_gpio_port *port = gpiochip_get_data(gc);
struct dwapb_gpio_port *port = to_dwapb_gpio_port(bgc);
struct dwapb_gpio *gpio = port->gpio; struct dwapb_gpio *gpio = port->gpio;
unsigned long flags, val_deb; 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); val_deb = dwapb_read(gpio, GPIO_PORTA_DEBOUNCE);
if (debounce) if (debounce)
...@@ -276,7 +270,7 @@ static int dwapb_gpio_set_debounce(struct gpio_chip *gc, ...@@ -276,7 +270,7 @@ static int dwapb_gpio_set_debounce(struct gpio_chip *gc,
else else
dwapb_write(gpio, GPIO_PORTA_DEBOUNCE, val_deb & ~mask); dwapb_write(gpio, GPIO_PORTA_DEBOUNCE, val_deb & ~mask);
spin_unlock_irqrestore(&bgc->lock, flags); spin_unlock_irqrestore(&gc->bgpio_lock, flags);
return 0; return 0;
} }
...@@ -295,7 +289,7 @@ static void dwapb_configure_irqs(struct dwapb_gpio *gpio, ...@@ -295,7 +289,7 @@ static void dwapb_configure_irqs(struct dwapb_gpio *gpio,
struct dwapb_gpio_port *port, struct dwapb_gpio_port *port,
struct dwapb_port_property *pp) 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 device_node *node = pp->node;
struct irq_chip_generic *irq_gc = NULL; struct irq_chip_generic *irq_gc = NULL;
unsigned int hwirq, ngpio = gc->ngpio; unsigned int hwirq, ngpio = gc->ngpio;
...@@ -369,13 +363,13 @@ static void dwapb_configure_irqs(struct dwapb_gpio *gpio, ...@@ -369,13 +363,13 @@ static void dwapb_configure_irqs(struct dwapb_gpio *gpio,
for (hwirq = 0 ; hwirq < ngpio ; hwirq++) for (hwirq = 0 ; hwirq < ngpio ; hwirq++)
irq_create_mapping(gpio->domain, 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) static void dwapb_irq_teardown(struct dwapb_gpio *gpio)
{ {
struct dwapb_gpio_port *port = &gpio->ports[0]; 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; unsigned int ngpio = gc->ngpio;
irq_hw_number_t hwirq; irq_hw_number_t hwirq;
...@@ -412,7 +406,7 @@ static int dwapb_gpio_add_port(struct dwapb_gpio *gpio, ...@@ -412,7 +406,7 @@ static int dwapb_gpio_add_port(struct dwapb_gpio *gpio,
dirout = gpio->regs + GPIO_SWPORTA_DDR + dirout = gpio->regs + GPIO_SWPORTA_DDR +
(pp->idx * GPIO_SWPORT_DDR_SIZE); (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); NULL, false);
if (err) { if (err) {
dev_err(gpio->dev, "failed to init gpio chip for %s\n", 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, ...@@ -421,19 +415,19 @@ static int dwapb_gpio_add_port(struct dwapb_gpio *gpio,
} }
#ifdef CONFIG_OF_GPIO #ifdef CONFIG_OF_GPIO
port->bgc.gc.of_node = pp->node; port->gc.of_node = pp->node;
#endif #endif
port->bgc.gc.ngpio = pp->ngpio; port->gc.ngpio = pp->ngpio;
port->bgc.gc.base = pp->gpio_base; port->gc.base = pp->gpio_base;
/* Only port A support debounce */ /* Only port A support debounce */
if (pp->idx == 0) if (pp->idx == 0)
port->bgc.gc.set_debounce = dwapb_gpio_set_debounce; port->gc.set_debounce = dwapb_gpio_set_debounce;
if (pp->irq) if (pp->irq)
dwapb_configure_irqs(gpio, port, pp); dwapb_configure_irqs(gpio, port, pp);
err = gpiochip_add(&port->bgc.gc); err = gpiochip_add_data(&port->gc, port);
if (err) if (err)
dev_err(gpio->dev, "failed to register gpiochip for %s\n", dev_err(gpio->dev, "failed to register gpiochip for %s\n",
pp->name); pp->name);
...@@ -449,7 +443,7 @@ static void dwapb_gpio_unregister(struct dwapb_gpio *gpio) ...@@ -449,7 +443,7 @@ static void dwapb_gpio_unregister(struct dwapb_gpio *gpio)
for (m = 0; m < gpio->nr_ports; ++m) for (m = 0; m < gpio->nr_ports; ++m)
if (gpio->ports[m].is_registered) if (gpio->ports[m].is_registered)
gpiochip_remove(&gpio->ports[m].bgc.gc); gpiochip_remove(&gpio->ports[m].gc);
} }
static struct dwapb_platform_data * static struct dwapb_platform_data *
...@@ -591,11 +585,11 @@ static int dwapb_gpio_suspend(struct device *dev) ...@@ -591,11 +585,11 @@ static int dwapb_gpio_suspend(struct device *dev)
{ {
struct platform_device *pdev = to_platform_device(dev); struct platform_device *pdev = to_platform_device(dev);
struct dwapb_gpio *gpio = platform_get_drvdata(pdev); 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; unsigned long flags;
int i; int i;
spin_lock_irqsave(&bgc->lock, flags); spin_lock_irqsave(&gc->bgpio_lock, flags);
for (i = 0; i < gpio->nr_ports; i++) { for (i = 0; i < gpio->nr_ports; i++) {
unsigned int offset; unsigned int offset;
unsigned int idx = gpio->ports[i].idx; unsigned int idx = gpio->ports[i].idx;
...@@ -624,7 +618,7 @@ static int dwapb_gpio_suspend(struct device *dev) ...@@ -624,7 +618,7 @@ static int dwapb_gpio_suspend(struct device *dev)
dwapb_write(gpio, GPIO_INTMASK, 0xffffffff); dwapb_write(gpio, GPIO_INTMASK, 0xffffffff);
} }
} }
spin_unlock_irqrestore(&bgc->lock, flags); spin_unlock_irqrestore(&gc->bgpio_lock, flags);
return 0; return 0;
} }
...@@ -633,11 +627,11 @@ static int dwapb_gpio_resume(struct device *dev) ...@@ -633,11 +627,11 @@ static int dwapb_gpio_resume(struct device *dev)
{ {
struct platform_device *pdev = to_platform_device(dev); struct platform_device *pdev = to_platform_device(dev);
struct dwapb_gpio *gpio = platform_get_drvdata(pdev); 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; unsigned long flags;
int i; int i;
spin_lock_irqsave(&bgc->lock, flags); spin_lock_irqsave(&gc->bgpio_lock, flags);
for (i = 0; i < gpio->nr_ports; i++) { for (i = 0; i < gpio->nr_ports; i++) {
unsigned int offset; unsigned int offset;
unsigned int idx = gpio->ports[i].idx; unsigned int idx = gpio->ports[i].idx;
...@@ -666,7 +660,7 @@ static int dwapb_gpio_resume(struct device *dev) ...@@ -666,7 +660,7 @@ static int dwapb_gpio_resume(struct device *dev)
dwapb_write(gpio, GPIO_PORTA_EOI, 0xffffffff); dwapb_write(gpio, GPIO_PORTA_EOI, 0xffffffff);
} }
} }
spin_unlock_irqrestore(&bgc->lock, flags); spin_unlock_irqrestore(&gc->bgpio_lock, flags);
return 0; return 0;
} }
......
...@@ -16,10 +16,11 @@ ...@@ -16,10 +16,11 @@
#include <linux/module.h> #include <linux/module.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/io.h> #include <linux/io.h>
#include <linux/gpio.h>
#include <linux/irq.h> #include <linux/irq.h>
#include <linux/slab.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/hardware.h>
#include <mach/gpio-ep93xx.h> #include <mach/gpio-ep93xx.h>
...@@ -28,7 +29,7 @@ ...@@ -28,7 +29,7 @@
struct ep93xx_gpio { struct ep93xx_gpio {
void __iomem *mmio_base; 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) ...@@ -319,26 +320,26 @@ static int ep93xx_gpio_to_irq(struct gpio_chip *chip, unsigned offset)
return 64 + gpio; 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 *mmio_base, struct ep93xx_gpio_bank *bank)
{ {
void __iomem *data = mmio_base + bank->data; void __iomem *data = mmio_base + bank->data;
void __iomem *dir = mmio_base + bank->dir; void __iomem *dir = mmio_base + bank->dir;
int err; 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) if (err)
return err; return err;
bgc->gc.label = bank->label; gc->label = bank->label;
bgc->gc.base = bank->base; gc->base = bank->base;
if (bank->has_debounce) { if (bank->has_debounce) {
bgc->gc.set_debounce = ep93xx_gpio_set_debounce; gc->set_debounce = ep93xx_gpio_set_debounce;
bgc->gc.to_irq = ep93xx_gpio_to_irq; 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) static int ep93xx_gpio_probe(struct platform_device *pdev)
...@@ -358,10 +359,10 @@ 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); return PTR_ERR(ep93xx_gpio->mmio_base);
for (i = 0; i < ARRAY_SIZE(ep93xx_gpio_banks); i++) { 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]; 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)) ep93xx_gpio->mmio_base, bank))
dev_warn(&pdev->dev, "Unable to add gpio bank %s\n", dev_warn(&pdev->dev, "Unable to add gpio bank %s\n",
bank->label); bank->label);
......
#include <linux/kernel.h> #include <linux/kernel.h>
#include <linux/init.h> #include <linux/init.h>
#include <linux/gpio.h>
#include <linux/gpio/driver.h> #include <linux/gpio/driver.h>
#include <linux/of_gpio.h> #include <linux/of_gpio.h>
#include <linux/io.h> #include <linux/io.h>
#include <linux/interrupt.h> #include <linux/interrupt.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/basic_mmio_gpio.h>
#define ETRAX_FS_rw_pa_dout 0 #define ETRAX_FS_rw_pa_dout 0
#define ETRAX_FS_r_pa_din 4 #define ETRAX_FS_r_pa_din 4
...@@ -67,7 +65,7 @@ struct etraxfs_gpio_block { ...@@ -67,7 +65,7 @@ struct etraxfs_gpio_block {
}; };
struct etraxfs_gpio_chip { struct etraxfs_gpio_chip {
struct bgpio_chip bgc; struct gpio_chip gc;
struct etraxfs_gpio_block *block; struct etraxfs_gpio_block *block;
}; };
...@@ -176,11 +174,6 @@ static const struct etraxfs_gpio_info etraxfs_gpio_artpec3 = { ...@@ -176,11 +174,6 @@ static const struct etraxfs_gpio_info etraxfs_gpio_artpec3 = {
.rw_intr_pins = ARTPEC3_rw_intr_pins, .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) static unsigned int etraxfs_gpio_chip_to_port(struct gpio_chip *gc)
{ {
return gc->label[0] - 'A'; return gc->label[0] - 'A';
...@@ -220,13 +213,13 @@ static unsigned int etraxfs_gpio_to_group_irq(unsigned int gpio) ...@@ -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, static unsigned int etraxfs_gpio_to_group_pin(struct etraxfs_gpio_chip *chip,
unsigned int gpio) 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) static void etraxfs_gpio_irq_ack(struct irq_data *d)
{ {
struct etraxfs_gpio_chip *chip = 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; struct etraxfs_gpio_block *block = chip->block;
unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq); unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq);
...@@ -236,7 +229,7 @@ static void etraxfs_gpio_irq_ack(struct irq_data *d) ...@@ -236,7 +229,7 @@ static void etraxfs_gpio_irq_ack(struct irq_data *d)
static void etraxfs_gpio_irq_mask(struct irq_data *d) static void etraxfs_gpio_irq_mask(struct irq_data *d)
{ {
struct etraxfs_gpio_chip *chip = 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; struct etraxfs_gpio_block *block = chip->block;
unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq); unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq);
...@@ -249,7 +242,7 @@ static void etraxfs_gpio_irq_mask(struct irq_data *d) ...@@ -249,7 +242,7 @@ static void etraxfs_gpio_irq_mask(struct irq_data *d)
static void etraxfs_gpio_irq_unmask(struct irq_data *d) static void etraxfs_gpio_irq_unmask(struct irq_data *d)
{ {
struct etraxfs_gpio_chip *chip = 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; struct etraxfs_gpio_block *block = chip->block;
unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq); unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq);
...@@ -262,7 +255,7 @@ static void etraxfs_gpio_irq_unmask(struct irq_data *d) ...@@ -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) static int etraxfs_gpio_irq_set_type(struct irq_data *d, u32 type)
{ {
struct etraxfs_gpio_chip *chip = 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; struct etraxfs_gpio_block *block = chip->block;
unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq); unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq);
u32 cfg; u32 cfg;
...@@ -299,7 +292,7 @@ static int etraxfs_gpio_irq_set_type(struct irq_data *d, u32 type) ...@@ -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) static int etraxfs_gpio_irq_request_resources(struct irq_data *d)
{ {
struct etraxfs_gpio_chip *chip = 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; struct etraxfs_gpio_block *block = chip->block;
unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq); unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq);
int ret = -EBUSY; int ret = -EBUSY;
...@@ -308,7 +301,7 @@ static int etraxfs_gpio_irq_request_resources(struct irq_data *d) ...@@ -308,7 +301,7 @@ static int etraxfs_gpio_irq_request_resources(struct irq_data *d)
if (block->group[grpirq]) if (block->group[grpirq])
goto out; goto out;
ret = gpiochip_lock_as_irq(&chip->bgc.gc, d->hwirq); ret = gpiochip_lock_as_irq(&chip->gc, d->hwirq);
if (ret) if (ret)
goto out; goto out;
...@@ -330,13 +323,13 @@ static int etraxfs_gpio_irq_request_resources(struct irq_data *d) ...@@ -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) static void etraxfs_gpio_irq_release_resources(struct irq_data *d)
{ {
struct etraxfs_gpio_chip *chip = 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; struct etraxfs_gpio_block *block = chip->block;
unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq); unsigned int grpirq = etraxfs_gpio_to_group_irq(d->hwirq);
spin_lock(&block->lock); spin_lock(&block->lock);
block->group[grpirq] = 0; 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); spin_unlock(&block->lock);
} }
...@@ -419,7 +412,7 @@ static int etraxfs_gpio_probe(struct platform_device *pdev) ...@@ -419,7 +412,7 @@ static int etraxfs_gpio_probe(struct platform_device *pdev)
for (i = 0; i < info->num_ports; i++) { for (i = 0; i < info->num_ports; i++) {
struct etraxfs_gpio_chip *chip = &chips[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]; const struct etraxfs_gpio_port *port = &info->ports[i];
unsigned long flags = BGPIOF_READ_OUTPUT_REG_SET; unsigned long flags = BGPIOF_READ_OUTPUT_REG_SET;
void __iomem *dat = regs + port->din; void __iomem *dat = regs + port->din;
...@@ -433,7 +426,7 @@ static int etraxfs_gpio_probe(struct platform_device *pdev) ...@@ -433,7 +426,7 @@ static int etraxfs_gpio_probe(struct platform_device *pdev)
flags = BGPIOF_NO_OUTPUT; flags = BGPIOF_NO_OUTPUT;
} }
ret = bgpio_init(bgc, dev, 4, ret = bgpio_init(gc, dev, 4,
dat, set, NULL, dirout, NULL, dat, set, NULL, dirout, NULL,
flags); flags);
if (ret) { if (ret) {
...@@ -442,28 +435,28 @@ static int etraxfs_gpio_probe(struct platform_device *pdev) ...@@ -442,28 +435,28 @@ static int etraxfs_gpio_probe(struct platform_device *pdev)
continue; continue;
} }
bgc->gc.ngpio = port->ngpio; gc->ngpio = port->ngpio;
bgc->gc.label = port->label; gc->label = port->label;
bgc->gc.of_node = dev->of_node; gc->of_node = dev->of_node;
bgc->gc.of_gpio_n_cells = 3; gc->of_gpio_n_cells = 3;
bgc->gc.of_xlate = etraxfs_gpio_of_xlate; gc->of_xlate = etraxfs_gpio_of_xlate;
ret = gpiochip_add(&bgc->gc); ret = gpiochip_add_data(gc, chip);
if (ret) { if (ret) {
dev_err(dev, "Unable to register port %s\n", dev_err(dev, "Unable to register port %s\n",
bgc->gc.label); gc->label);
continue; continue;
} }
if (i > 0 && !allportsirq) if (i > 0 && !allportsirq)
continue; 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); handle_level_irq, IRQ_TYPE_NONE);
if (ret) { if (ret) {
dev_err(dev, "Unable to add irqchip to port %s\n", dev_err(dev, "Unable to add irqchip to port %s\n",
bgc->gc.label); gc->label);
} }
} }
......
...@@ -24,7 +24,7 @@ ...@@ -24,7 +24,7 @@
#include <linux/of_gpio.h> #include <linux/of_gpio.h>
#include <linux/of_address.h> #include <linux/of_address.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/basic_mmio_gpio.h> #include <linux/gpio/driver.h>
#define GEF_GPIO_DIRECT 0x00 #define GEF_GPIO_DIRECT 0x00
#define GEF_GPIO_IN 0x04 #define GEF_GPIO_IN 0x04
...@@ -55,19 +55,19 @@ static int __init gef_gpio_probe(struct platform_device *pdev) ...@@ -55,19 +55,19 @@ static int __init gef_gpio_probe(struct platform_device *pdev)
{ {
const struct of_device_id *of_id = const struct of_device_id *of_id =
of_match_device(gef_gpio_ids, &pdev->dev); of_match_device(gef_gpio_ids, &pdev->dev);
struct bgpio_chip *bgc; struct gpio_chip *gc;
void __iomem *regs; void __iomem *regs;
int ret; int ret;
bgc = devm_kzalloc(&pdev->dev, sizeof(*bgc), GFP_KERNEL); gc = devm_kzalloc(&pdev->dev, sizeof(*gc), GFP_KERNEL);
if (!bgc) if (!gc)
return -ENOMEM; return -ENOMEM;
regs = of_iomap(pdev->dev.of_node, 0); regs = of_iomap(pdev->dev.of_node, 0);
if (!regs) if (!regs)
return -ENOMEM; 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_OUT, NULL, NULL,
regs + GEF_GPIO_DIRECT, BGPIOF_BIG_ENDIAN_BYTE_ORDER); regs + GEF_GPIO_DIRECT, BGPIOF_BIG_ENDIAN_BYTE_ORDER);
if (ret) { if (ret) {
...@@ -76,20 +76,20 @@ static int __init gef_gpio_probe(struct platform_device *pdev) ...@@ -76,20 +76,20 @@ static int __init gef_gpio_probe(struct platform_device *pdev)
} }
/* Setup pointers to chip functions */ /* 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); GFP_KERNEL);
if (!bgc->gc.label) { if (!gc->label) {
ret = -ENOMEM; ret = -ENOMEM;
goto err0; goto err0;
} }
bgc->gc.base = -1; gc->base = -1;
bgc->gc.ngpio = (u16)(uintptr_t)of_id->data; gc->ngpio = (u16)(uintptr_t)of_id->data;
bgc->gc.of_gpio_n_cells = 2; gc->of_gpio_n_cells = 2;
bgc->gc.of_node = pdev->dev.of_node; gc->of_node = pdev->dev.of_node;
/* This function adds a memory mapped GPIO chip */ /* This function adds a memory mapped GPIO chip */
ret = gpiochip_add(&bgc->gc); ret = gpiochip_add_data(gc, NULL);
if (ret) if (ret)
goto err0; goto err0;
......
...@@ -56,12 +56,11 @@ o ` ~~~~\___/~~~~ ` controller in FPGA is ,.` ...@@ -56,12 +56,11 @@ o ` ~~~~\___/~~~~ ` controller in FPGA is ,.`
#include <linux/log2.h> #include <linux/log2.h>
#include <linux/ioport.h> #include <linux/ioport.h>
#include <linux/io.h> #include <linux/io.h>
#include <linux/gpio.h> #include <linux/gpio/driver.h>
#include <linux/slab.h> #include <linux/slab.h>
#include <linux/bitops.h> #include <linux/bitops.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/mod_devicetable.h> #include <linux/mod_devicetable.h>
#include <linux/basic_mmio_gpio.h>
static void bgpio_write8(void __iomem *reg, unsigned long data) static void bgpio_write8(void __iomem *reg, unsigned long data)
{ {
...@@ -125,33 +124,30 @@ static unsigned long bgpio_read32be(void __iomem *reg) ...@@ -125,33 +124,30 @@ static unsigned long bgpio_read32be(void __iomem *reg)
return ioread32be(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); 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) 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) static int bgpio_get_set(struct gpio_chip *gc, unsigned int gpio)
{ {
struct bgpio_chip *bgc = to_bgpio_chip(gc); unsigned long pinmask = gc->pin2mask(gc, gpio);
unsigned long pinmask = bgc->pin2mask(bgc, gpio);
if (bgc->dir & pinmask) if (gc->bgpio_dir & pinmask)
return !!(bgc->read_reg(bgc->reg_set) & pinmask); return !!(gc->read_reg(gc->reg_set) & pinmask);
else 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) static int bgpio_get(struct gpio_chip *gc, unsigned int gpio)
{ {
struct bgpio_chip *bgc = to_bgpio_chip(gc); return !!(gc->read_reg(gc->reg_dat) & gc->pin2mask(gc, gpio));
return !!(bgc->read_reg(bgc->reg_dat) & bgc->pin2mask(bgc, gpio));
} }
static void bgpio_set_none(struct gpio_chip *gc, unsigned int gpio, int val) 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) ...@@ -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) static void bgpio_set(struct gpio_chip *gc, unsigned int gpio, int val)
{ {
struct bgpio_chip *bgc = to_bgpio_chip(gc); unsigned long mask = gc->pin2mask(gc, gpio);
unsigned long mask = bgc->pin2mask(bgc, gpio);
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&bgc->lock, flags); spin_lock_irqsave(&gc->bgpio_lock, flags);
if (val) if (val)
bgc->data |= mask; gc->bgpio_data |= mask;
else 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, static void bgpio_set_with_clear(struct gpio_chip *gc, unsigned int gpio,
int val) int val)
{ {
struct bgpio_chip *bgc = to_bgpio_chip(gc); unsigned long mask = gc->pin2mask(gc, gpio);
unsigned long mask = bgc->pin2mask(bgc, gpio);
if (val) if (val)
bgc->write_reg(bgc->reg_set, mask); gc->write_reg(gc->reg_set, mask);
else 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) 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 = gc->pin2mask(gc, gpio);
unsigned long mask = bgc->pin2mask(bgc, gpio);
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&bgc->lock, flags); spin_lock_irqsave(&gc->bgpio_lock, flags);
if (val) if (val)
bgc->data |= mask; gc->bgpio_data |= mask;
else 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 *mask, unsigned long *bits,
unsigned long *set_mask, unsigned long *set_mask,
unsigned long *clear_mask) unsigned long *clear_mask)
...@@ -216,19 +209,19 @@ static void bgpio_multiple_get_masks(struct bgpio_chip *bgc, ...@@ -216,19 +209,19 @@ static void bgpio_multiple_get_masks(struct bgpio_chip *bgc,
*set_mask = 0; *set_mask = 0;
*clear_mask = 0; *clear_mask = 0;
for (i = 0; i < bgc->bits; i++) { for (i = 0; i < gc->bgpio_bits; i++) {
if (*mask == 0) if (*mask == 0)
break; break;
if (__test_and_clear_bit(i, mask)) { if (__test_and_clear_bit(i, mask)) {
if (test_bit(i, bits)) if (test_bit(i, bits))
*set_mask |= bgc->pin2mask(bgc, i); *set_mask |= gc->pin2mask(gc, i);
else 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 *mask,
unsigned long *bits, unsigned long *bits,
void __iomem *reg) void __iomem *reg)
...@@ -236,47 +229,42 @@ static void bgpio_set_multiple_single_reg(struct bgpio_chip *bgc, ...@@ -236,47 +229,42 @@ static void bgpio_set_multiple_single_reg(struct bgpio_chip *bgc,
unsigned long flags; unsigned long flags;
unsigned long set_mask, clear_mask; 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; gc->bgpio_data |= set_mask;
bgc->data &= ~clear_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, static void bgpio_set_multiple(struct gpio_chip *gc, unsigned long *mask,
unsigned long *bits) unsigned long *bits)
{ {
struct bgpio_chip *bgc = to_bgpio_chip(gc); bgpio_set_multiple_single_reg(gc, mask, bits, gc->reg_dat);
bgpio_set_multiple_single_reg(bgc, mask, bits, bgc->reg_dat);
} }
static void bgpio_set_multiple_set(struct gpio_chip *gc, unsigned long *mask, static void bgpio_set_multiple_set(struct gpio_chip *gc, unsigned long *mask,
unsigned long *bits) unsigned long *bits)
{ {
struct bgpio_chip *bgc = to_bgpio_chip(gc); bgpio_set_multiple_single_reg(gc, mask, bits, gc->reg_set);
bgpio_set_multiple_single_reg(bgc, mask, bits, bgc->reg_set);
} }
static void bgpio_set_multiple_with_clear(struct gpio_chip *gc, static void bgpio_set_multiple_with_clear(struct gpio_chip *gc,
unsigned long *mask, unsigned long *mask,
unsigned long *bits) unsigned long *bits)
{ {
struct bgpio_chip *bgc = to_bgpio_chip(gc);
unsigned long set_mask, clear_mask; 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) if (set_mask)
bgc->write_reg(bgc->reg_set, set_mask); gc->write_reg(gc->reg_set, set_mask);
if (clear_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) 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, ...@@ -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) static int bgpio_dir_in(struct gpio_chip *gc, unsigned int gpio)
{ {
struct bgpio_chip *bgc = to_bgpio_chip(gc);
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&bgc->lock, flags); spin_lock_irqsave(&gc->bgpio_lock, flags);
bgc->dir &= ~bgc->pin2mask(bgc, gpio); gc->bgpio_dir &= ~gc->pin2mask(gc, gpio);
bgc->write_reg(bgc->reg_dir, bgc->dir); gc->write_reg(gc->reg_dir, gc->bgpio_dir);
spin_unlock_irqrestore(&bgc->lock, flags); spin_unlock_irqrestore(&gc->bgpio_lock, flags);
return 0; return 0;
} }
static int bgpio_get_dir(struct gpio_chip *gc, unsigned int gpio) static int bgpio_get_dir(struct gpio_chip *gc, unsigned int gpio)
{ {
struct bgpio_chip *bgc = to_bgpio_chip(gc); /* Return 0 if output, 1 of input */
return !(gc->read_reg(gc->reg_dir) & gc->pin2mask(gc, gpio));
return (bgc->read_reg(bgc->reg_dir) & bgc->pin2mask(bgc, gpio)) ?
GPIOF_DIR_OUT : GPIOF_DIR_IN;
} }
static int bgpio_dir_out(struct gpio_chip *gc, unsigned int gpio, int val) 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; unsigned long flags;
gc->set(gc, gpio, val); gc->set(gc, gpio, val);
spin_lock_irqsave(&bgc->lock, flags); spin_lock_irqsave(&gc->bgpio_lock, flags);
bgc->dir |= bgc->pin2mask(bgc, gpio); gc->bgpio_dir |= gc->pin2mask(gc, gpio);
bgc->write_reg(bgc->reg_dir, bgc->dir); gc->write_reg(gc->reg_dir, gc->bgpio_dir);
spin_unlock_irqrestore(&bgc->lock, flags); spin_unlock_irqrestore(&gc->bgpio_lock, flags);
return 0; return 0;
} }
static int bgpio_dir_in_inv(struct gpio_chip *gc, unsigned int gpio) static int bgpio_dir_in_inv(struct gpio_chip *gc, unsigned int gpio)
{ {
struct bgpio_chip *bgc = to_bgpio_chip(gc);
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&bgc->lock, flags); spin_lock_irqsave(&gc->bgpio_lock, flags);
bgc->dir |= bgc->pin2mask(bgc, gpio); gc->bgpio_dir |= gc->pin2mask(gc, gpio);
bgc->write_reg(bgc->reg_dir, bgc->dir); gc->write_reg(gc->reg_dir, gc->bgpio_dir);
spin_unlock_irqrestore(&bgc->lock, flags); spin_unlock_irqrestore(&gc->bgpio_lock, flags);
return 0; return 0;
} }
static int bgpio_dir_out_inv(struct gpio_chip *gc, unsigned int gpio, int val) 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; unsigned long flags;
gc->set(gc, gpio, val); gc->set(gc, gpio, val);
spin_lock_irqsave(&bgc->lock, flags); spin_lock_irqsave(&gc->bgpio_lock, flags);
bgc->dir &= ~bgc->pin2mask(bgc, gpio); gc->bgpio_dir &= ~gc->pin2mask(gc, gpio);
bgc->write_reg(bgc->reg_dir, bgc->dir); gc->write_reg(gc->reg_dir, gc->bgpio_dir);
spin_unlock_irqrestore(&bgc->lock, flags); spin_unlock_irqrestore(&gc->bgpio_lock, flags);
return 0; return 0;
} }
static int bgpio_get_dir_inv(struct gpio_chip *gc, unsigned int gpio) static int bgpio_get_dir_inv(struct gpio_chip *gc, unsigned int gpio)
{ {
struct bgpio_chip *bgc = to_bgpio_chip(gc); /* Return 0 if output, 1 if input */
return !!(gc->read_reg(gc->reg_dir) & gc->pin2mask(gc, gpio));
return (bgc->read_reg(bgc->reg_dir) & bgc->pin2mask(bgc, gpio)) ?
GPIOF_DIR_IN : GPIOF_DIR_OUT;
} }
static int bgpio_setup_accessors(struct device *dev, static int bgpio_setup_accessors(struct device *dev,
struct bgpio_chip *bgc, struct gpio_chip *gc,
bool bit_be, bool bit_be,
bool byte_be) bool byte_be)
{ {
switch (bgc->bits) { switch (gc->bgpio_bits) {
case 8: case 8:
bgc->read_reg = bgpio_read8; gc->read_reg = bgpio_read8;
bgc->write_reg = bgpio_write8; gc->write_reg = bgpio_write8;
break; break;
case 16: case 16:
if (byte_be) { if (byte_be) {
bgc->read_reg = bgpio_read16be; gc->read_reg = bgpio_read16be;
bgc->write_reg = bgpio_write16be; gc->write_reg = bgpio_write16be;
} else { } else {
bgc->read_reg = bgpio_read16; gc->read_reg = bgpio_read16;
bgc->write_reg = bgpio_write16; gc->write_reg = bgpio_write16;
} }
break; break;
case 32: case 32:
if (byte_be) { if (byte_be) {
bgc->read_reg = bgpio_read32be; gc->read_reg = bgpio_read32be;
bgc->write_reg = bgpio_write32be; gc->write_reg = bgpio_write32be;
} else { } else {
bgc->read_reg = bgpio_read32; gc->read_reg = bgpio_read32;
bgc->write_reg = bgpio_write32; gc->write_reg = bgpio_write32;
} }
break; break;
#if BITS_PER_LONG >= 64 #if BITS_PER_LONG >= 64
...@@ -414,17 +394,17 @@ static int bgpio_setup_accessors(struct device *dev, ...@@ -414,17 +394,17 @@ static int bgpio_setup_accessors(struct device *dev,
"64 bit big endian byte order unsupported\n"); "64 bit big endian byte order unsupported\n");
return -EINVAL; return -EINVAL;
} else { } else {
bgc->read_reg = bgpio_read64; gc->read_reg = bgpio_read64;
bgc->write_reg = bgpio_write64; gc->write_reg = bgpio_write64;
} }
break; break;
#endif /* BITS_PER_LONG >= 64 */ #endif /* BITS_PER_LONG >= 64 */
default: 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; return -EINVAL;
} }
bgc->pin2mask = bit_be ? bgpio_pin2mask_be : bgpio_pin2mask; gc->pin2mask = bit_be ? bgpio_pin2mask_be : bgpio_pin2mask;
return 0; return 0;
} }
...@@ -451,44 +431,44 @@ static int bgpio_setup_accessors(struct device *dev, ...@@ -451,44 +431,44 @@ static int bgpio_setup_accessors(struct device *dev,
* - an input direction register (named "dirin") where a 1 bit indicates * - an input direction register (named "dirin") where a 1 bit indicates
* the GPIO is an input. * 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 *dat,
void __iomem *set, void __iomem *set,
void __iomem *clr, void __iomem *clr,
unsigned long flags) unsigned long flags)
{ {
bgc->reg_dat = dat; gc->reg_dat = dat;
if (!bgc->reg_dat) if (!gc->reg_dat)
return -EINVAL; return -EINVAL;
if (set && clr) { if (set && clr) {
bgc->reg_set = set; gc->reg_set = set;
bgc->reg_clr = clr; gc->reg_clr = clr;
bgc->gc.set = bgpio_set_with_clear; gc->set = bgpio_set_with_clear;
bgc->gc.set_multiple = bgpio_set_multiple_with_clear; gc->set_multiple = bgpio_set_multiple_with_clear;
} else if (set && !clr) { } else if (set && !clr) {
bgc->reg_set = set; gc->reg_set = set;
bgc->gc.set = bgpio_set_set; gc->set = bgpio_set_set;
bgc->gc.set_multiple = bgpio_set_multiple_set; gc->set_multiple = bgpio_set_multiple_set;
} else if (flags & BGPIOF_NO_OUTPUT) { } else if (flags & BGPIOF_NO_OUTPUT) {
bgc->gc.set = bgpio_set_none; gc->set = bgpio_set_none;
bgc->gc.set_multiple = NULL; gc->set_multiple = NULL;
} else { } else {
bgc->gc.set = bgpio_set; gc->set = bgpio_set;
bgc->gc.set_multiple = bgpio_set_multiple; gc->set_multiple = bgpio_set_multiple;
} }
if (!(flags & BGPIOF_UNREADABLE_REG_SET) && if (!(flags & BGPIOF_UNREADABLE_REG_SET) &&
(flags & BGPIOF_READ_OUTPUT_REG_SET)) (flags & BGPIOF_READ_OUTPUT_REG_SET))
bgc->gc.get = bgpio_get_set; gc->get = bgpio_get_set;
else else
bgc->gc.get = bgpio_get; gc->get = bgpio_get;
return 0; 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 *dirout,
void __iomem *dirin, void __iomem *dirin,
unsigned long flags) unsigned long flags)
...@@ -496,21 +476,21 @@ static int bgpio_setup_direction(struct bgpio_chip *bgc, ...@@ -496,21 +476,21 @@ static int bgpio_setup_direction(struct bgpio_chip *bgc,
if (dirout && dirin) { if (dirout && dirin) {
return -EINVAL; return -EINVAL;
} else if (dirout) { } else if (dirout) {
bgc->reg_dir = dirout; gc->reg_dir = dirout;
bgc->gc.direction_output = bgpio_dir_out; gc->direction_output = bgpio_dir_out;
bgc->gc.direction_input = bgpio_dir_in; gc->direction_input = bgpio_dir_in;
bgc->gc.get_direction = bgpio_get_dir; gc->get_direction = bgpio_get_dir;
} else if (dirin) { } else if (dirin) {
bgc->reg_dir = dirin; gc->reg_dir = dirin;
bgc->gc.direction_output = bgpio_dir_out_inv; gc->direction_output = bgpio_dir_out_inv;
bgc->gc.direction_input = bgpio_dir_in_inv; gc->direction_input = bgpio_dir_in_inv;
bgc->gc.get_direction = bgpio_get_dir_inv; gc->get_direction = bgpio_get_dir_inv;
} else { } else {
if (flags & BGPIOF_NO_OUTPUT) if (flags & BGPIOF_NO_OUTPUT)
bgc->gc.direction_output = bgpio_dir_out_err; gc->direction_output = bgpio_dir_out_err;
else else
bgc->gc.direction_output = bgpio_simple_dir_out; gc->direction_output = bgpio_simple_dir_out;
bgc->gc.direction_input = bgpio_simple_dir_in; gc->direction_input = bgpio_simple_dir_in;
} }
return 0; return 0;
...@@ -524,14 +504,7 @@ static int bgpio_request(struct gpio_chip *chip, unsigned gpio_pin) ...@@ -524,14 +504,7 @@ static int bgpio_request(struct gpio_chip *chip, unsigned gpio_pin)
return -EINVAL; return -EINVAL;
} }
int bgpio_remove(struct bgpio_chip *bgc) int bgpio_init(struct gpio_chip *gc, struct device *dev,
{
gpiochip_remove(&bgc->gc);
return 0;
}
EXPORT_SYMBOL_GPL(bgpio_remove);
int bgpio_init(struct bgpio_chip *bgc, struct device *dev,
unsigned long sz, void __iomem *dat, void __iomem *set, unsigned long sz, void __iomem *dat, void __iomem *set,
void __iomem *clr, void __iomem *dirout, void __iomem *dirin, void __iomem *clr, void __iomem *dirout, void __iomem *dirin,
unsigned long flags) unsigned long flags)
...@@ -541,36 +514,36 @@ int bgpio_init(struct bgpio_chip *bgc, struct device *dev, ...@@ -541,36 +514,36 @@ int bgpio_init(struct bgpio_chip *bgc, struct device *dev,
if (!is_power_of_2(sz)) if (!is_power_of_2(sz))
return -EINVAL; return -EINVAL;
bgc->bits = sz * 8; gc->bgpio_bits = sz * 8;
if (bgc->bits > BITS_PER_LONG) if (gc->bgpio_bits > BITS_PER_LONG)
return -EINVAL; return -EINVAL;
spin_lock_init(&bgc->lock); spin_lock_init(&gc->bgpio_lock);
bgc->gc.parent = dev; gc->parent = dev;
bgc->gc.label = dev_name(dev); gc->label = dev_name(dev);
bgc->gc.base = -1; gc->base = -1;
bgc->gc.ngpio = bgc->bits; gc->ngpio = gc->bgpio_bits;
bgc->gc.request = bgpio_request; gc->request = bgpio_request;
ret = bgpio_setup_io(bgc, dat, set, clr, flags); ret = bgpio_setup_io(gc, dat, set, clr, flags);
if (ret) if (ret)
return 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); flags & BGPIOF_BIG_ENDIAN_BYTE_ORDER);
if (ret) if (ret)
return ret; return ret;
ret = bgpio_setup_direction(bgc, dirout, dirin, flags); ret = bgpio_setup_direction(gc, dirout, dirin, flags);
if (ret) if (ret)
return ret; return ret;
bgc->data = bgc->read_reg(bgc->reg_dat); gc->bgpio_data = gc->read_reg(gc->reg_dat);
if (bgc->gc.set == bgpio_set_set && if (gc->set == bgpio_set_set &&
!(flags & BGPIOF_UNREADABLE_REG_SET)) !(flags & BGPIOF_UNREADABLE_REG_SET))
bgc->data = bgc->read_reg(bgc->reg_set); gc->bgpio_data = gc->read_reg(gc->reg_set);
if (bgc->reg_dir && !(flags & BGPIOF_UNREADABLE_REG_DIR)) if (gc->reg_dir && !(flags & BGPIOF_UNREADABLE_REG_DIR))
bgc->dir = bgc->read_reg(bgc->reg_dir); gc->bgpio_dir = gc->read_reg(gc->reg_dir);
return ret; return ret;
} }
...@@ -608,7 +581,7 @@ static int bgpio_pdev_probe(struct platform_device *pdev) ...@@ -608,7 +581,7 @@ static int bgpio_pdev_probe(struct platform_device *pdev)
unsigned long sz; unsigned long sz;
unsigned long flags = pdev->id_entry->driver_data; unsigned long flags = pdev->id_entry->driver_data;
int err; int err;
struct bgpio_chip *bgc; struct gpio_chip *gc;
struct bgpio_pdata *pdata = dev_get_platdata(dev); struct bgpio_pdata *pdata = dev_get_platdata(dev);
r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dat"); r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "dat");
...@@ -637,32 +610,33 @@ static int bgpio_pdev_probe(struct platform_device *pdev) ...@@ -637,32 +610,33 @@ static int bgpio_pdev_probe(struct platform_device *pdev)
if (IS_ERR(dirin)) if (IS_ERR(dirin))
return PTR_ERR(dirin); return PTR_ERR(dirin);
bgc = devm_kzalloc(&pdev->dev, sizeof(*bgc), GFP_KERNEL); gc = devm_kzalloc(&pdev->dev, sizeof(*gc), GFP_KERNEL);
if (!bgc) if (!gc)
return -ENOMEM; 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) if (err)
return err; return err;
if (pdata) { if (pdata) {
if (pdata->label) if (pdata->label)
bgc->gc.label = pdata->label; gc->label = pdata->label;
bgc->gc.base = pdata->base; gc->base = pdata->base;
if (pdata->ngpio > 0) 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) 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[] = { static const struct platform_device_id bgpio_id_table[] = {
......
...@@ -31,7 +31,7 @@ ...@@ -31,7 +31,7 @@
#include <linux/gpio.h> #include <linux/gpio.h>
#include <linux/slab.h> #include <linux/slab.h>
#include <linux/err.h> #include <linux/err.h>
#include <linux/basic_mmio_gpio.h> #include <linux/gpio/driver.h>
#include <linux/interrupt.h> #include <linux/interrupt.h>
#include <linux/irq.h> #include <linux/irq.h>
#include <linux/irqdomain.h> #include <linux/irqdomain.h>
...@@ -63,7 +63,7 @@ struct grgpio_lirq { ...@@ -63,7 +63,7 @@ struct grgpio_lirq {
}; };
struct grgpio_priv { struct grgpio_priv {
struct bgpio_chip bgc; struct gpio_chip gc;
void __iomem *regs; void __iomem *regs;
struct device *dev; struct device *dev;
...@@ -92,29 +92,22 @@ struct grgpio_priv { ...@@ -92,29 +92,22 @@ struct grgpio_priv {
struct grgpio_lirq lirqs[GRGPIO_MAX_NGPIO]; 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, static void grgpio_set_imask(struct grgpio_priv *priv, unsigned int offset,
int val) int val)
{ {
struct bgpio_chip *bgc = &priv->bgc; struct gpio_chip *gc = &priv->gc;
unsigned long mask = bgc->pin2mask(bgc, offset); unsigned long mask = gc->pin2mask(gc, offset);
if (val) if (val)
priv->imask |= mask; priv->imask |= mask;
else else
priv->imask &= ~mask; 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) 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) if (offset >= gc->ngpio)
return -ENXIO; return -ENXIO;
...@@ -158,15 +151,15 @@ static int grgpio_irq_set_type(struct irq_data *d, unsigned int type) ...@@ -158,15 +151,15 @@ static int grgpio_irq_set_type(struct irq_data *d, unsigned int type)
return -EINVAL; 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; ipol = priv->gc.read_reg(priv->regs + GRGPIO_IPOL) & ~mask;
iedge = priv->bgc.read_reg(priv->regs + GRGPIO_IEDGE) & ~mask; iedge = priv->gc.read_reg(priv->regs + GRGPIO_IEDGE) & ~mask;
priv->bgc.write_reg(priv->regs + GRGPIO_IPOL, ipol | pol); priv->gc.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_IEDGE, iedge | edge);
spin_unlock_irqrestore(&priv->bgc.lock, flags); spin_unlock_irqrestore(&priv->gc.bgpio_lock, flags);
return 0; return 0;
} }
...@@ -177,11 +170,11 @@ static void grgpio_irq_mask(struct irq_data *d) ...@@ -177,11 +170,11 @@ static void grgpio_irq_mask(struct irq_data *d)
int offset = d->hwirq; int offset = d->hwirq;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&priv->bgc.lock, flags); spin_lock_irqsave(&priv->gc.bgpio_lock, flags);
grgpio_set_imask(priv, offset, 0); 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) static void grgpio_irq_unmask(struct irq_data *d)
...@@ -190,11 +183,11 @@ 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; int offset = d->hwirq;
unsigned long flags; unsigned long flags;
spin_lock_irqsave(&priv->bgc.lock, flags); spin_lock_irqsave(&priv->gc.bgpio_lock, flags);
grgpio_set_imask(priv, offset, 1); 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 = { static struct irq_chip grgpio_irq_chip = {
...@@ -207,12 +200,12 @@ 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) static irqreturn_t grgpio_irq_handler(int irq, void *dev)
{ {
struct grgpio_priv *priv = dev; struct grgpio_priv *priv = dev;
int ngpio = priv->bgc.gc.ngpio; int ngpio = priv->gc.ngpio;
unsigned long flags; unsigned long flags;
int i; int i;
int match = 0; 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 * 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) ...@@ -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) if (!match)
dev_warn(priv->dev, "No gpio line matched irq %d\n", irq); 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, ...@@ -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", dev_dbg(priv->dev, "Mapping irq %d for gpio line %d\n",
irq, offset); irq, offset);
spin_lock_irqsave(&priv->bgc.lock, flags); spin_lock_irqsave(&priv->gc.bgpio_lock, flags);
/* Request underlying irq if not already requested */ /* Request underlying irq if not already requested */
lirq->irq = irq; lirq->irq = irq;
...@@ -273,14 +266,14 @@ static int grgpio_irq_map(struct irq_domain *d, unsigned int irq, ...@@ -273,14 +266,14 @@ static int grgpio_irq_map(struct irq_domain *d, unsigned int irq,
"Could not request underlying irq %d\n", "Could not request underlying irq %d\n",
uirq->uirq); uirq->uirq);
spin_unlock_irqrestore(&priv->bgc.lock, flags); spin_unlock_irqrestore(&priv->gc.bgpio_lock, flags);
return ret; return ret;
} }
} }
uirq->refcnt++; uirq->refcnt++;
spin_unlock_irqrestore(&priv->bgc.lock, flags); spin_unlock_irqrestore(&priv->gc.bgpio_lock, flags);
/* Setup irq */ /* Setup irq */
irq_set_chip_data(irq, priv); irq_set_chip_data(irq, priv);
...@@ -298,13 +291,13 @@ static void grgpio_irq_unmap(struct irq_domain *d, unsigned int irq) ...@@ -298,13 +291,13 @@ static void grgpio_irq_unmap(struct irq_domain *d, unsigned int irq)
struct grgpio_lirq *lirq; struct grgpio_lirq *lirq;
struct grgpio_uirq *uirq; struct grgpio_uirq *uirq;
unsigned long flags; unsigned long flags;
int ngpio = priv->bgc.gc.ngpio; int ngpio = priv->gc.ngpio;
int i; int i;
irq_set_chip_and_handler(irq, NULL, NULL); irq_set_chip_and_handler(irq, NULL, NULL);
irq_set_chip_data(irq, 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 */ /* Free underlying irq if last user unmapped */
index = -1; index = -1;
...@@ -326,7 +319,7 @@ static void grgpio_irq_unmap(struct irq_domain *d, unsigned int irq) ...@@ -326,7 +319,7 @@ static void grgpio_irq_unmap(struct irq_domain *d, unsigned int irq)
free_irq(uirq->uirq, priv); 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 = { static const struct irq_domain_ops grgpio_irq_domain_ops = {
...@@ -341,7 +334,6 @@ static int grgpio_probe(struct platform_device *ofdev) ...@@ -341,7 +334,6 @@ static int grgpio_probe(struct platform_device *ofdev)
struct device_node *np = ofdev->dev.of_node; struct device_node *np = ofdev->dev.of_node;
void __iomem *regs; void __iomem *regs;
struct gpio_chip *gc; struct gpio_chip *gc;
struct bgpio_chip *bgc;
struct grgpio_priv *priv; struct grgpio_priv *priv;
struct resource *res; struct resource *res;
int err; int err;
...@@ -359,8 +351,8 @@ static int grgpio_probe(struct platform_device *ofdev) ...@@ -359,8 +351,8 @@ static int grgpio_probe(struct platform_device *ofdev)
if (IS_ERR(regs)) if (IS_ERR(regs))
return PTR_ERR(regs); return PTR_ERR(regs);
bgc = &priv->bgc; gc = &priv->gc;
err = bgpio_init(bgc, &ofdev->dev, 4, regs + GRGPIO_DATA, err = bgpio_init(gc, &ofdev->dev, 4, regs + GRGPIO_DATA,
regs + GRGPIO_OUTPUT, NULL, regs + GRGPIO_DIR, NULL, regs + GRGPIO_OUTPUT, NULL, regs + GRGPIO_DIR, NULL,
BGPIOF_BIG_ENDIAN_BYTE_ORDER); BGPIOF_BIG_ENDIAN_BYTE_ORDER);
if (err) { if (err) {
...@@ -369,10 +361,9 @@ static int grgpio_probe(struct platform_device *ofdev) ...@@ -369,10 +361,9 @@ static int grgpio_probe(struct platform_device *ofdev)
} }
priv->regs = regs; priv->regs = regs;
priv->imask = bgc->read_reg(regs + GRGPIO_IMASK); priv->imask = gc->read_reg(regs + GRGPIO_IMASK);
priv->dev = &ofdev->dev; priv->dev = &ofdev->dev;
gc = &bgc->gc;
gc->of_node = np; gc->of_node = np;
gc->owner = THIS_MODULE; gc->owner = THIS_MODULE;
gc->to_irq = grgpio_to_irq; gc->to_irq = grgpio_to_irq;
...@@ -435,7 +426,7 @@ static int grgpio_probe(struct platform_device *ofdev) ...@@ -435,7 +426,7 @@ static int grgpio_probe(struct platform_device *ofdev)
platform_set_drvdata(ofdev, priv); platform_set_drvdata(ofdev, priv);
err = gpiochip_add(gc); err = gpiochip_add_data(gc, priv);
if (err) { if (err) {
dev_err(&ofdev->dev, "Could not add gpiochip\n"); dev_err(&ofdev->dev, "Could not add gpiochip\n");
if (priv->domain) if (priv->domain)
...@@ -456,7 +447,7 @@ static int grgpio_remove(struct platform_device *ofdev) ...@@ -456,7 +447,7 @@ static int grgpio_remove(struct platform_device *ofdev)
int i; int i;
int ret = 0; int ret = 0;
spin_lock_irqsave(&priv->bgc.lock, flags); spin_lock_irqsave(&priv->gc.bgpio_lock, flags);
if (priv->domain) { if (priv->domain) {
for (i = 0; i < GRGPIO_MAX_NGPIO; i++) { for (i = 0; i < GRGPIO_MAX_NGPIO; i++) {
...@@ -467,13 +458,13 @@ static int grgpio_remove(struct platform_device *ofdev) ...@@ -467,13 +458,13 @@ static int grgpio_remove(struct platform_device *ofdev)
} }
} }
gpiochip_remove(&priv->bgc.gc); gpiochip_remove(&priv->gc);
if (priv->domain) if (priv->domain)
irq_domain_remove(priv->domain); irq_domain_remove(priv->domain);
out: out:
spin_unlock_irqrestore(&priv->bgc.lock, flags); spin_unlock_irqrestore(&priv->gc.bgpio_lock, flags);
return ret; return ret;
} }
......
...@@ -14,7 +14,6 @@ ...@@ -14,7 +14,6 @@
#include <linux/init.h> #include <linux/init.h>
#include <linux/irq.h> #include <linux/irq.h>
#include <linux/io.h> #include <linux/io.h>
#include <linux/gpio.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/module.h> #include <linux/module.h>
#include <linux/of_address.h> #include <linux/of_address.h>
...@@ -23,7 +22,7 @@ ...@@ -23,7 +22,7 @@
#include <linux/delay.h> #include <linux/delay.h>
#include <linux/timer.h> #include <linux/timer.h>
#include <linux/bitops.h> #include <linux/bitops.h>
#include <linux/basic_mmio_gpio.h> #include <linux/gpio/driver.h>
#define GPIO_DATA_OUT 0x00 #define GPIO_DATA_OUT 0x00
#define GPIO_DATA_IN 0x04 #define GPIO_DATA_IN 0x04
...@@ -33,12 +32,12 @@ static int moxart_gpio_probe(struct platform_device *pdev) ...@@ -33,12 +32,12 @@ static int moxart_gpio_probe(struct platform_device *pdev)
{ {
struct device *dev = &pdev->dev; struct device *dev = &pdev->dev;
struct resource *res; struct resource *res;
struct bgpio_chip *bgc; struct gpio_chip *gc;
void __iomem *base; void __iomem *base;
int ret; int ret;
bgc = devm_kzalloc(dev, sizeof(*bgc), GFP_KERNEL); gc = devm_kzalloc(dev, sizeof(*gc), GFP_KERNEL);
if (!bgc) if (!gc)
return -ENOMEM; return -ENOMEM;
res = platform_get_resource(pdev, IORESOURCE_MEM, 0); res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
...@@ -46,7 +45,7 @@ static int moxart_gpio_probe(struct platform_device *pdev) ...@@ -46,7 +45,7 @@ static int moxart_gpio_probe(struct platform_device *pdev)
if (IS_ERR(base)) if (IS_ERR(base))
return PTR_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_DATA_OUT, NULL,
base + GPIO_PIN_DIRECTION, NULL, base + GPIO_PIN_DIRECTION, NULL,
BGPIOF_READ_OUTPUT_REG_SET); BGPIOF_READ_OUTPUT_REG_SET);
...@@ -55,16 +54,16 @@ static int moxart_gpio_probe(struct platform_device *pdev) ...@@ -55,16 +54,16 @@ static int moxart_gpio_probe(struct platform_device *pdev)
return ret; return ret;
} }
bgc->gc.label = "moxart-gpio"; gc->label = "moxart-gpio";
bgc->gc.request = gpiochip_generic_request; gc->request = gpiochip_generic_request;
bgc->gc.free = gpiochip_generic_free; gc->free = gpiochip_generic_free;
bgc->data = bgc->read_reg(bgc->reg_set); gc->bgpio_data = bgc->read_reg(bgc->reg_set);
bgc->gc.base = 0; gc->base = 0;
bgc->gc.ngpio = 32; gc->ngpio = 32;
bgc->gc.parent = dev; gc->parent = dev;
bgc->gc.owner = THIS_MODULE; gc->owner = THIS_MODULE;
ret = gpiochip_add(&bgc->gc); ret = gpiochip_add_data(gc, NULL);
if (ret) { if (ret) {
dev_err(dev, "%s: gpiochip_add failed\n", dev_err(dev, "%s: gpiochip_add failed\n",
dev->of_node->full_name); dev->of_node->full_name);
......
...@@ -26,10 +26,11 @@ ...@@ -26,10 +26,11 @@
#include <linux/irq.h> #include <linux/irq.h>
#include <linux/irqdomain.h> #include <linux/irqdomain.h>
#include <linux/irqchip/chained_irq.h> #include <linux/irqchip/chained_irq.h>
#include <linux/gpio.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/slab.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.h>
#include <linux/of_device.h> #include <linux/of_device.h>
#include <linux/module.h> #include <linux/module.h>
...@@ -64,7 +65,7 @@ struct mxc_gpio_port { ...@@ -64,7 +65,7 @@ struct mxc_gpio_port {
int irq; int irq;
int irq_high; int irq_high;
struct irq_domain *domain; struct irq_domain *domain;
struct bgpio_chip bgc; struct gpio_chip gc;
u32 both_edges; u32 both_edges;
}; };
...@@ -172,7 +173,7 @@ static int gpio_set_irq_type(struct irq_data *d, u32 type) ...@@ -172,7 +173,7 @@ static int gpio_set_irq_type(struct irq_data *d, u32 type)
struct mxc_gpio_port *port = gc->private; struct mxc_gpio_port *port = gc->private;
u32 bit, val; u32 bit, val;
u32 gpio_idx = d->hwirq; u32 gpio_idx = d->hwirq;
u32 gpio = port->bgc.gc.base + gpio_idx; u32 gpio = port->gc.base + gpio_idx;
int edge; int edge;
void __iomem *reg = port->base; void __iomem *reg = port->base;
...@@ -398,9 +399,7 @@ static void mxc_gpio_get_hw(struct platform_device *pdev) ...@@ -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) 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 = gpiochip_get_data(gc);
struct mxc_gpio_port *port =
container_of(bgc, struct mxc_gpio_port, bgc);
return irq_find_mapping(port->domain, offset); return irq_find_mapping(port->domain, offset);
} }
...@@ -451,7 +450,7 @@ static int mxc_gpio_probe(struct platform_device *pdev) ...@@ -451,7 +450,7 @@ static int mxc_gpio_probe(struct platform_device *pdev)
port); port);
} }
err = bgpio_init(&port->bgc, &pdev->dev, 4, err = bgpio_init(&port->gc, &pdev->dev, 4,
port->base + GPIO_PSR, port->base + GPIO_PSR,
port->base + GPIO_DR, NULL, port->base + GPIO_DR, NULL,
port->base + GPIO_GDIR, NULL, port->base + GPIO_GDIR, NULL,
...@@ -459,13 +458,13 @@ static int mxc_gpio_probe(struct platform_device *pdev) ...@@ -459,13 +458,13 @@ static int mxc_gpio_probe(struct platform_device *pdev)
if (err) if (err)
goto out_bgio; goto out_bgio;
port->bgc.gc.to_irq = mxc_gpio_to_irq; port->gc.to_irq = mxc_gpio_to_irq;
port->bgc.gc.base = (pdev->id < 0) ? of_alias_get_id(np, "gpio") * 32 : port->gc.base = (pdev->id < 0) ? of_alias_get_id(np, "gpio") * 32 :
pdev->id * 32; pdev->id * 32;
err = gpiochip_add(&port->bgc.gc); err = gpiochip_add_data(&port->gc, port);
if (err) if (err)
goto out_bgpio_remove; goto out_bgio;
irq_base = irq_alloc_descs(-1, 0, 32, numa_node_id()); irq_base = irq_alloc_descs(-1, 0, 32, numa_node_id());
if (irq_base < 0) { if (irq_base < 0) {
...@@ -494,9 +493,7 @@ static int mxc_gpio_probe(struct platform_device *pdev) ...@@ -494,9 +493,7 @@ static int mxc_gpio_probe(struct platform_device *pdev)
out_irqdesc_free: out_irqdesc_free:
irq_free_descs(irq_base, 32); irq_free_descs(irq_base, 32);
out_gpiochip_remove: out_gpiochip_remove:
gpiochip_remove(&port->bgc.gc); gpiochip_remove(&port->gc);
out_bgpio_remove:
bgpio_remove(&port->bgc);
out_bgio: out_bgio:
dev_info(&pdev->dev, "%s failed with errno %d\n", __func__, err); dev_info(&pdev->dev, "%s failed with errno %d\n", __func__, err);
return err; return err;
......
...@@ -26,13 +26,14 @@ ...@@ -26,13 +26,14 @@
#include <linux/io.h> #include <linux/io.h>
#include <linux/irq.h> #include <linux/irq.h>
#include <linux/irqdomain.h> #include <linux/irqdomain.h>
#include <linux/gpio.h>
#include <linux/of.h> #include <linux/of.h>
#include <linux/of_address.h> #include <linux/of_address.h>
#include <linux/of_device.h> #include <linux/of_device.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/slab.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> #include <linux/module.h>
#define MXS_SET 0x4 #define MXS_SET 0x4
...@@ -64,7 +65,7 @@ struct mxs_gpio_port { ...@@ -64,7 +65,7 @@ struct mxs_gpio_port {
int id; int id;
int irq; int irq;
struct irq_domain *domain; struct irq_domain *domain;
struct bgpio_chip bgc; struct gpio_chip gc;
enum mxs_gpio_id devid; enum mxs_gpio_id devid;
u32 both_edges; u32 both_edges;
}; };
...@@ -93,7 +94,7 @@ static int mxs_gpio_set_irq_type(struct irq_data *d, unsigned int type) ...@@ -93,7 +94,7 @@ static int mxs_gpio_set_irq_type(struct irq_data *d, unsigned int type)
port->both_edges &= ~pin_mask; port->both_edges &= ~pin_mask;
switch (type) { switch (type) {
case IRQ_TYPE_EDGE_BOTH: 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) if (val)
edge = GPIO_INT_FALL_EDGE; edge = GPIO_INT_FALL_EDGE;
else else
...@@ -225,18 +226,14 @@ static int __init mxs_gpio_init_gc(struct mxs_gpio_port *port, int irq_base) ...@@ -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) 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 = gpiochip_get_data(gc);
struct mxs_gpio_port *port =
container_of(bgc, struct mxs_gpio_port, bgc);
return irq_find_mapping(port->domain, offset); return irq_find_mapping(port->domain, offset);
} }
static int mxs_gpio_get_direction(struct gpio_chip *gc, unsigned 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 = gpiochip_get_data(gc);
struct mxs_gpio_port *port =
container_of(bgc, struct mxs_gpio_port, bgc);
u32 mask = 1 << offset; u32 mask = 1 << offset;
u32 dir; u32 dir;
...@@ -330,26 +327,24 @@ static int mxs_gpio_probe(struct platform_device *pdev) ...@@ -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, irq_set_chained_handler_and_data(port->irq, mxs_gpio_irq_handler,
port); 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_DIN(port),
port->base + PINCTRL_DOUT(port) + MXS_SET, port->base + PINCTRL_DOUT(port) + MXS_SET,
port->base + PINCTRL_DOUT(port) + MXS_CLR, port->base + PINCTRL_DOUT(port) + MXS_CLR,
port->base + PINCTRL_DOE(port), NULL, 0); port->base + PINCTRL_DOE(port), NULL, 0);
if (err) if (err)
goto out_irqdesc_free; goto out_irqdomain_remove;
port->bgc.gc.to_irq = mxs_gpio_to_irq; port->gc.to_irq = mxs_gpio_to_irq;
port->bgc.gc.get_direction = mxs_gpio_get_direction; port->gc.get_direction = mxs_gpio_get_direction;
port->bgc.gc.base = port->id * 32; port->gc.base = port->id * 32;
err = gpiochip_add(&port->bgc.gc); err = gpiochip_add_data(&port->gc, port);
if (err) if (err)
goto out_bgpio_remove; goto out_irqdomain_remove;
return 0; return 0;
out_bgpio_remove:
bgpio_remove(&port->bgc);
out_irqdomain_remove: out_irqdomain_remove:
irq_domain_remove(port->domain); irq_domain_remove(port->domain);
out_irqdesc_free: out_irqdesc_free:
......
...@@ -10,7 +10,6 @@ ...@@ -10,7 +10,6 @@
*/ */
#include <linux/errno.h> #include <linux/errno.h>
#include <linux/gpio.h>
#include <linux/init.h> #include <linux/init.h>
#include <linux/io.h> #include <linux/io.h>
#include <linux/irq.h> #include <linux/irq.h>
...@@ -20,7 +19,7 @@ ...@@ -20,7 +19,7 @@
#include <linux/pci.h> #include <linux/pci.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/of_irq.h> #include <linux/of_irq.h>
#include <linux/basic_mmio_gpio.h> #include <linux/gpio/driver.h>
#define DRV_NAME "sdv_gpio" #define DRV_NAME "sdv_gpio"
#define SDV_NUM_PUB_GPIOS 12 #define SDV_NUM_PUB_GPIOS 12
...@@ -43,7 +42,7 @@ struct sdv_gpio_chip_data { ...@@ -43,7 +42,7 @@ struct sdv_gpio_chip_data {
void __iomem *gpio_pub_base; void __iomem *gpio_pub_base;
struct irq_domain *id; struct irq_domain *id;
struct irq_chip_generic *gc; 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) 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, ...@@ -226,14 +225,14 @@ static int sdv_gpio_probe(struct pci_dev *pdev,
writel(mux_val, sd->gpio_pub_base + GPMUXCTL); 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, sd->gpio_pub_base + GPINR, sd->gpio_pub_base + GPOUTR,
NULL, sd->gpio_pub_base + GPOER, NULL, 0); NULL, sd->gpio_pub_base + GPOER, NULL, 0);
if (ret) if (ret)
goto unmap; 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) { if (ret < 0) {
dev_err(&pdev->dev, "gpiochip_add() failed.\n"); dev_err(&pdev->dev, "gpiochip_add() failed.\n");
goto unmap; goto unmap;
...@@ -265,7 +264,7 @@ static void sdv_gpio_remove(struct pci_dev *pdev) ...@@ -265,7 +264,7 @@ static void sdv_gpio_remove(struct pci_dev *pdev)
free_irq(pdev->irq, sd); free_irq(pdev->irq, sd);
irq_free_descs(sd->irq_base, SDV_NUM_PUB_GPIOS); 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); pci_release_region(pdev, GPIO_BAR);
iounmap(sd->gpio_pub_base); iounmap(sd->gpio_pub_base);
pci_disable_device(pdev); pci_disable_device(pdev);
......
...@@ -23,10 +23,8 @@ ...@@ -23,10 +23,8 @@
#include <linux/io.h> #include <linux/io.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/of_gpio.h> #include <linux/of_gpio.h>
#include <linux/gpio.h>
#include <linux/gpio/driver.h> #include <linux/gpio/driver.h>
#include <linux/acpi.h> #include <linux/acpi.h>
#include <linux/basic_mmio_gpio.h>
#include "gpiolib.h" #include "gpiolib.h"
...@@ -43,38 +41,31 @@ ...@@ -43,38 +41,31 @@
/** /**
* struct xgene_gpio_sb - GPIO-Standby private data structure. * 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 * @irq: Mapping GPIO pins and interrupt number
* nirq: Number of GPIO pins that supports interrupt * nirq: Number of GPIO pins that supports interrupt
*/ */
struct xgene_gpio_sb { struct xgene_gpio_sb {
struct bgpio_chip bgc; struct gpio_chip gc;
u32 *irq; u32 *irq;
u32 nirq; u32 nirq;
}; };
static inline struct xgene_gpio_sb *to_xgene_gpio_sb(struct gpio_chip *gc) static void xgene_gpio_set_bit(struct gpio_chip *gc, void __iomem *reg, u32 gpio, int val)
{
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)
{ {
u32 data; u32 data;
data = bgc->read_reg(reg); data = gc->read_reg(reg);
if (val) if (val)
data |= GPIO_MASK(gpio); data |= GPIO_MASK(gpio);
else else
data &= ~GPIO_MASK(gpio); 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) 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]) if (priv->irq[gpio])
return priv->irq[gpio]; return priv->irq[gpio];
...@@ -99,15 +90,15 @@ static int xgene_gpio_sb_probe(struct platform_device *pdev) ...@@ -99,15 +90,15 @@ static int xgene_gpio_sb_probe(struct platform_device *pdev)
if (IS_ERR(regs)) if (IS_ERR(regs))
return PTR_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_IN_ADDR,
regs + MPA_GPIO_OUT_ADDR, NULL, regs + MPA_GPIO_OUT_ADDR, NULL,
regs + MPA_GPIO_OE_ADDR, NULL, 0); regs + MPA_GPIO_OE_ADDR, NULL, 0);
if (ret) if (ret)
return ret; return ret;
priv->bgc.gc.to_irq = apm_gpio_sb_to_irq; priv->gc.to_irq = apm_gpio_sb_to_irq;
priv->bgc.gc.ngpio = XGENE_MAX_GPIO_DS; priv->gc.ngpio = XGENE_MAX_GPIO_DS;
priv->nirq = XGENE_MAX_GPIO_DS_IRQ; priv->nirq = XGENE_MAX_GPIO_DS_IRQ;
...@@ -118,14 +109,14 @@ static int xgene_gpio_sb_probe(struct platform_device *pdev) ...@@ -118,14 +109,14 @@ static int xgene_gpio_sb_probe(struct platform_device *pdev)
for (i = 0; i < priv->nirq; i++) { for (i = 0; i < priv->nirq; i++) {
priv->irq[default_lines[i]] = platform_get_irq(pdev, 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); 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); platform_set_drvdata(pdev, priv);
ret = gpiochip_add(&priv->bgc.gc); ret = gpiochip_add_data(&priv->gc, priv);
if (ret) if (ret)
dev_err(&pdev->dev, "failed to register X-Gene GPIO Standby driver\n"); dev_err(&pdev->dev, "failed to register X-Gene GPIO Standby driver\n");
else else
...@@ -133,7 +124,7 @@ static int xgene_gpio_sb_probe(struct platform_device *pdev) ...@@ -133,7 +124,7 @@ static int xgene_gpio_sb_probe(struct platform_device *pdev)
if (priv->nirq > 0) { if (priv->nirq > 0) {
/* Register interrupt handlers for gpio signaled acpi events */ /* Register interrupt handlers for gpio signaled acpi events */
acpi_gpiochip_request_interrupts(&priv->bgc.gc); acpi_gpiochip_request_interrupts(&priv->gc);
} }
return ret; return ret;
...@@ -144,10 +135,11 @@ static int xgene_gpio_sb_remove(struct platform_device *pdev) ...@@ -144,10 +135,11 @@ static int xgene_gpio_sb_remove(struct platform_device *pdev)
struct xgene_gpio_sb *priv = platform_get_drvdata(pdev); struct xgene_gpio_sb *priv = platform_get_drvdata(pdev);
if (priv->nirq > 0) { 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[] = { static const struct of_device_id xgene_gpio_sb_of_match[] = {
......
...@@ -11,7 +11,7 @@ ...@@ -11,7 +11,7 @@
* Copyright (C) 2012 ARM Limited * Copyright (C) 2012 ARM Limited
*/ */
#include <linux/basic_mmio_gpio.h> #include <linux/gpio/driver.h>
#include <linux/err.h> #include <linux/err.h>
#include <linux/io.h> #include <linux/io.h>
#include <linux/mfd/core.h> #include <linux/mfd/core.h>
...@@ -164,7 +164,7 @@ static int vexpress_sysreg_probe(struct platform_device *pdev) ...@@ -164,7 +164,7 @@ static int vexpress_sysreg_probe(struct platform_device *pdev)
{ {
struct resource *mem; struct resource *mem;
void __iomem *base; void __iomem *base;
struct bgpio_chip *mmc_gpio_chip; struct gpio_chip *mmc_gpio_chip;
int master; int master;
u32 dt_hbi; u32 dt_hbi;
...@@ -201,8 +201,8 @@ static int vexpress_sysreg_probe(struct platform_device *pdev) ...@@ -201,8 +201,8 @@ static int vexpress_sysreg_probe(struct platform_device *pdev)
return -ENOMEM; return -ENOMEM;
bgpio_init(mmc_gpio_chip, &pdev->dev, 0x4, base + SYS_MCI, bgpio_init(mmc_gpio_chip, &pdev->dev, 0x4, base + SYS_MCI,
NULL, NULL, NULL, NULL, 0); NULL, NULL, NULL, NULL, 0);
mmc_gpio_chip->gc.ngpio = 2; mmc_gpio_chip->ngpio = 2;
gpiochip_add(&mmc_gpio_chip->gc); gpiochip_add(mmc_gpio_chip);
return mfd_add_devices(&pdev->dev, PLATFORM_DEVID_AUTO, return mfd_add_devices(&pdev->dev, PLATFORM_DEVID_AUTO,
vexpress_sysreg_cells, vexpress_sysreg_cells,
......
/*
* 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 @@ ...@@ -8,6 +8,7 @@
#include <linux/irqdomain.h> #include <linux/irqdomain.h>
#include <linux/lockdep.h> #include <linux/lockdep.h>
#include <linux/pinctrl/pinctrl.h> #include <linux/pinctrl/pinctrl.h>
#include <linux/kconfig.h>
struct device; struct device;
struct gpio_desc; struct gpio_desc;
...@@ -65,6 +66,23 @@ struct seq_file; ...@@ -65,6 +66,23 @@ struct seq_file;
* registers. * registers.
* @irq_not_threaded: flag must be set if @can_sleep is set but the * @irq_not_threaded: flag must be set if @can_sleep is set but the
* IRQs don't need to be threaded * 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 * @irqchip: GPIO IRQ chip impl, provided by GPIO driver
* @irqdomain: Interrupt translation domain; responsible for mapping * @irqdomain: Interrupt translation domain; responsible for mapping
* between GPIO hwirq number and linux irq number * between GPIO hwirq number and linux irq number
...@@ -128,6 +146,20 @@ struct gpio_chip { ...@@ -128,6 +146,20 @@ struct gpio_chip {
bool can_sleep; bool can_sleep;
bool irq_not_threaded; 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 #ifdef CONFIG_GPIOLIB_IRQCHIP
/* /*
* With CONFIG_GPIOLIB_IRQCHIP we get an irqchip inside the gpiolib * 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) ...@@ -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); 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 #ifdef CONFIG_GPIOLIB_IRQCHIP
void gpiochip_set_chained_irqchip(struct gpio_chip *gpiochip, void gpiochip_set_chained_irqchip(struct gpio_chip *gpiochip,
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment