From b7da6044662b62c5b0f8fded77ee85e63632fad1 Mon Sep 17 00:00:00 2001 From: florian Date: Thu, 27 Nov 2008 10:38:36 +0000 Subject: Commit changes on the files for gpiolib git-svn-id: svn://svn.openwrt.org/openwrt/trunk@13374 3c298f89-4303-0410-b956-a3cf2f4a3e73 --- .../linux/brcm63xx/files/arch/mips/bcm63xx/gpio.c | 64 ++++++++++++++++------ 1 file changed, 47 insertions(+), 17 deletions(-) (limited to 'target/linux/brcm63xx/files/arch') diff --git a/target/linux/brcm63xx/files/arch/mips/bcm63xx/gpio.c b/target/linux/brcm63xx/files/arch/mips/bcm63xx/gpio.c index 2c203a69e..b78d3fdaf 100644 --- a/target/linux/brcm63xx/files/arch/mips/bcm63xx/gpio.c +++ b/target/linux/brcm63xx/files/arch/mips/bcm63xx/gpio.c @@ -4,26 +4,29 @@ * for more details. * * Copyright (C) 2008 Maxime Bizon + * Copyright (C) 2008 Florian Fainelli */ #include #include #include +#include +#include + #include #include #include #include -static DEFINE_SPINLOCK(bcm63xx_gpio_lock); - -void bcm63xx_gpio_set_dataout(int gpio, int val) +static void bcm63xx_gpio_set(struct gpio_chip *chip, + unsigned gpio, int val) { u32 reg; u32 mask; u32 tmp; unsigned long flags; - if (gpio >= BCM63XX_GPIO_COUNT) + if (gpio >= chip->ngpio) BUG(); if (gpio < 32) { @@ -34,24 +37,22 @@ void bcm63xx_gpio_set_dataout(int gpio, int val) mask = 1 << (gpio - 32); } - spin_lock_irqsave(&bcm63xx_gpio_lock, flags); + local_irq_save(flags); tmp = bcm_gpio_readl(reg); if (val) tmp |= mask; else tmp &= ~mask; bcm_gpio_writel(tmp, reg); - spin_unlock_irqrestore(&bcm63xx_gpio_lock, flags); + local_irq_restore(flags); } -EXPORT_SYMBOL(bcm63xx_gpio_set_dataout); - -int bcm63xx_gpio_get_datain(int gpio) +static int bcm63xx_gpio_get(struct gpio_chip *chip, unsigned gpio) { u32 reg; u32 mask; - if (gpio >= BCM63XX_GPIO_COUNT) + if (gpio >= chip->ngpio) BUG(); if (gpio < 32) { @@ -65,16 +66,15 @@ int bcm63xx_gpio_get_datain(int gpio) return !!(bcm_gpio_readl(reg) & mask); } -EXPORT_SYMBOL(bcm63xx_gpio_get_datain); - -void bcm63xx_gpio_set_direction(int gpio, int dir) +static int bcm63xx_gpio_set_direction(struct gpio_chip *chip, + unsigned gpio, int dir) { u32 reg; u32 mask; u32 tmp; unsigned long flags; - if (gpio >= BCM63XX_GPIO_COUNT) + if (gpio >= chip->ngpio) BUG(); if (gpio < 32) { @@ -85,14 +85,44 @@ void bcm63xx_gpio_set_direction(int gpio, int dir) mask = 1 << (gpio - 32); } - spin_lock_irqsave(&bcm63xx_gpio_lock, flags); + local_irq_save(flags); tmp = bcm_gpio_readl(reg); if (dir == GPIO_DIR_IN) tmp &= ~mask; else tmp |= mask; bcm_gpio_writel(tmp, reg); - spin_unlock_irqrestore(&bcm63xx_gpio_lock, flags); + local_irq_restore(flags); + + return 0; +} + +static int bcm63xx_gpio_direction_input(struct gpio_chip *chip, unsigned gpio) +{ + return bcm63xx_gpio_set_direction(chip, gpio, GPIO_DIR_IN); } -EXPORT_SYMBOL(bcm63xx_gpio_set_direction); +static int bcm63xx_gpio_direction_output(struct gpio_chip *chip, + unsigned gpio, int value) +{ + bcm63xx_gpio_set(chip, gpio, value); + return bcm63xx_gpio_set_direction(chip, gpio, GPIO_DIR_OUT); +} + + +static struct gpio_chip bcm63xx_gpio_chip = { + .label = "bcm63xx-gpio", + .direction_input = bcm63xx_gpio_direction_input, + .direction_output = bcm63xx_gpio_direction_output, + .get = bcm63xx_gpio_get, + .set = bcm63xx_gpio_set, + .base = 0, + .ngpio = BCM63XX_GPIO_COUNT, +}; + +static int __init bcm63xx_gpio_init(void) +{ + printk(KERN_INFO "registering %d GPIOs\n", BCM63XX_GPIO_COUNT); + return gpiochip_add(&bcm63xx_gpio_chip); +} +arch_initcall(bcm63xx_gpio_init); -- cgit v1.2.3