convert to gpiolib

Signed-off-by:	karlp@tweak.net.au

SVN-Revision: 29486
lede-17.01
John Crispin 2011-12-09 07:52:10 +00:00
parent 542d1f1b61
commit 934eef78ca
2 changed files with 536 additions and 0 deletions

View File

@ -52,7 +52,9 @@ CONFIG_GENERIC_FIND_LAST_BIT=y
CONFIG_GENERIC_FIND_NEXT_BIT=y
CONFIG_GENERIC_GPIO=y
CONFIG_GENERIC_HARDIRQS_NO__DO_IRQ=y
CONFIG_GPIOLIB=y
CONFIG_GPIO_DEVICE=y
CONFIG_GPIO_SYSFS=y
# CONFIG_HAMRADIO is not set
# CONFIG_HARDLOCKUP_DETECTOR is not set
CONFIG_HARDWARE_WATCHPOINTS=y

View File

@ -0,0 +1,534 @@
--- a/arch/mips/Kconfig
+++ b/arch/mips/Kconfig
@@ -111,7 +111,7 @@ config ATHEROS_AR231X
select SYS_HAS_CPU_MIPS32_R1
select SYS_SUPPORTS_BIG_ENDIAN
select SYS_SUPPORTS_32BIT_KERNEL
- select GENERIC_GPIO
+ select ARCH_REQUIRE_GPIOLIB
select SYS_HAS_EARLY_PRINTK
help
Support for AR231x and AR531x based boards
--- a/arch/mips/ar231x/Kconfig
+++ b/arch/mips/ar231x/Kconfig
@@ -13,7 +13,6 @@ config ATHEROS_AR2315
select SYS_HAS_CPU_MIPS32_R1
select SYS_SUPPORTS_32BIT_KERNEL
select SYS_SUPPORTS_BIG_ENDIAN
- select GENERIC_GPIO
default y
config ATHEROS_AR2315_PCI
--- a/arch/mips/ar231x/ar2315.c
+++ b/arch/mips/ar231x/ar2315.c
@@ -23,12 +23,12 @@
#include <linux/reboot.h>
#include <linux/delay.h>
#include <linux/leds.h>
+#include <linux/gpio.h>
#include <asm/bootinfo.h>
#include <asm/reboot.h>
#include <asm/time.h>
#include <asm/irq.h>
#include <asm/io.h>
-#include <asm/gpio.h>
#include <ar231x_platform.h>
#include <ar2315_regs.h>
@@ -312,17 +312,6 @@ ar2315_irq_init(void)
setup_irq(AR2315_IRQ_MISC_INTRS, &cascade);
}
-const struct ar231x_gpiodev ar2315_gpiodev;
-
-static u32
-ar2315_gpio_get_output(void)
-{
- u32 reg;
- reg = ar231x_read_reg(AR2315_GPIO_CR);
- reg &= ar2315_gpiodev.valid_mask;
- return reg;
-}
-
static u32
ar2315_gpio_set_output(u32 mask, u32 val)
{
@@ -336,11 +325,11 @@ ar2315_gpio_set_output(u32 mask, u32 val
}
static u32
-ar2315_gpio_get(void)
+ar2315_gpio_get(u32 valid_mask)
{
u32 reg;
reg = ar231x_read_reg(AR2315_GPIO_DI);
- reg &= ar2315_gpiodev.valid_mask;
+ reg &= valid_mask;
return reg;
}
@@ -355,14 +344,75 @@ ar2315_gpio_set(u32 mask, u32 value)
return reg;
}
-const struct ar231x_gpiodev ar2315_gpiodev = {
+/*
+ * gpiolib implementation. Original legacy mask based methods
+ * preserved for now.
+ */
+static int
+ar2315_gpio_get_value(struct gpio_chip *chip, unsigned gpio)
+{
+ struct ar231x_gpio_chip *gpch =
+ container_of(chip, struct ar231x_gpio_chip, chip);
+ u32 mask = 1 << gpio;
+ u32 rett;
+ if (!(gpch->valid_mask & mask))
+ return 0;
+ rett = ar2315_gpio_get(gpch->valid_mask); // legacy code
+ return !!(rett & mask);
+}
+
+static void
+ar2315_gpio_set_value(struct gpio_chip *chip, unsigned gpio, int value)
+{
+ struct ar231x_gpio_chip *gpch =
+ container_of(chip, struct ar231x_gpio_chip, chip);
+ u32 mask = 1 << gpio;
+ if (!(gpch->valid_mask & mask))
+ return;
+ ar2315_gpio_set(mask, (!!value) * mask); // legacy
+}
+
+static int
+ar2315_gpio_direction_input(struct gpio_chip *chip, unsigned gpio)
+{
+ struct ar231x_gpio_chip *gpch =
+ container_of(chip, struct ar231x_gpio_chip, chip);
+ u32 mask = 1 << gpio;
+ if (!(gpch->valid_mask & mask))
+ return -ENXIO;
+ ar2315_gpio_set_output(mask, 0); // legacy
+ return 0;
+}
+
+static int
+ar2315_gpio_direction_output(struct gpio_chip *chip, unsigned gpio, int value)
+{
+ struct ar231x_gpio_chip *gpch =
+ container_of(chip, struct ar231x_gpio_chip, chip);
+ u32 mask = 1 << gpio;
+ if (!(gpch->valid_mask & mask))
+ return -ENXIO;
+ ar2315_gpio_set_output(mask, mask); // both legacy
+ ar2315_gpio_set(mask, (!!value) * mask);
+ return 0;
+}
+
+static struct ar231x_gpio_chip ar2315_gpio_chip = {
.valid_mask = (1 << 22) - 1,
- .get_output = ar2315_gpio_get_output,
- .set_output = ar2315_gpio_set_output,
- .get = ar2315_gpio_get,
- .set = ar2315_gpio_set,
+ .chip = {
+ .label = "ar2315-gpio",
+ .direction_input = ar2315_gpio_direction_input,
+ .direction_output = ar2315_gpio_direction_output,
+ .set = ar2315_gpio_set_value,
+ .get = ar2315_gpio_get_value,
+ .base = 0,
+ .ngpio = AR531X_GPIO_IRQ_COUNT, // 22
+ }
};
+// end of gpiolib
+
+
static struct ar231x_eth ar2315_eth_data = {
.reset_base = AR2315_RESET,
.reset_mac = AR2315_RESET_ENET0,
@@ -496,7 +546,7 @@ static struct platform_device ar2315_gpi
};
static void __init
-ar2315_init_gpio(void)
+ar2315_init_gpio_leds(void)
{
static char led_names[6][6];
int i, led = 0;
@@ -522,7 +572,7 @@ ar2315_init_gpio(void)
platform_device_register(&ar2315_gpio_leds);
}
#else
-static inline void ar2315_init_gpio(void)
+static inline void ar2315_init_gpio_leds(void)
{
}
#endif
@@ -537,7 +587,7 @@ ar2315_init_devices(void)
ar231x_find_config(ar2315_flash_limit());
ar2315_eth_data.macaddr = ar231x_board.config->enet0_mac;
- ar2315_init_gpio();
+ ar2315_init_gpio_leds();
platform_device_register(&ar2315_wdt);
platform_device_register(&ar2315_spiflash);
ar231x_add_ethernet(0, KSEG1ADDR(AR2315_ENET0), AR2315_IRQ_ENET0_INTRS,
@@ -633,6 +683,25 @@ ar2315_time_init(void)
mips_hpt_frequency = ar2315_cpu_frequency() / 2;
}
+int __init
+ar2315_gpio_init(void)
+{
+ int ret;
+ struct ar231x_gpio_chip *gpch;
+ gpch = &ar2315_gpio_chip;
+ ret = gpiochip_add(&gpch->chip);
+ if (ret) {
+ printk(KERN_ERR "%s: failed to add gpiochip\n",
+ gpch->chip.label);
+ return ret;
+ }
+ printk(KERN_INFO "%s: registered %d GPIOs\n",
+ gpch->chip.label, gpch->chip.ngpio);
+ return ret;
+}
+
+
+
void __init
ar2315_prom_init(void)
{
@@ -659,7 +728,7 @@ ar2315_prom_init(void)
ar231x_devtype = DEV_TYPE_AR2315;
break;
}
- ar231x_gpiodev = &ar2315_gpiodev;
+ ar2315_gpio_init();
ar231x_board.devid = devid;
}
--- a/arch/mips/ar231x/ar5312.c
+++ b/arch/mips/ar231x/ar5312.c
@@ -23,12 +23,12 @@
#include <linux/kernel.h>
#include <linux/reboot.h>
#include <linux/leds.h>
+#include <linux/gpio.h>
#include <asm/bootinfo.h>
#include <asm/reboot.h>
#include <asm/time.h>
#include <asm/irq.h>
#include <asm/io.h>
-#include <gpio.h>
#include <ar231x_platform.h>
#include <ar5312_regs.h>
@@ -160,17 +160,6 @@ void __init ar5312_irq_init(void)
setup_irq(AR5312_IRQ_MISC_INTRS, &cascade);
}
-const struct ar231x_gpiodev ar5312_gpiodev;
-
-static u32
-ar5312_gpio_get_output(void)
-{
- u32 reg;
- reg = ~(ar231x_read_reg(AR531X_GPIO_CR));
- reg &= ar5312_gpiodev.valid_mask;
- return reg;
-}
-
static u32
ar5312_gpio_set_output(u32 mask, u32 val)
{
@@ -184,11 +173,11 @@ ar5312_gpio_set_output(u32 mask, u32 val
}
static u32
-ar5312_gpio_get(void)
+ar5312_gpio_get(u32 valid_mask)
{
u32 reg;
reg = ar231x_read_reg(AR531X_GPIO_DI);
- reg &= ar5312_gpiodev.valid_mask;
+ reg &= valid_mask;
return reg;
}
@@ -203,14 +192,72 @@ ar5312_gpio_set(u32 mask, u32 value)
return reg;
}
-const struct ar231x_gpiodev ar5312_gpiodev = {
- .valid_mask = (1 << 8) - 1,
- .get_output = ar5312_gpio_get_output,
- .set_output = ar5312_gpio_set_output,
- .get = ar5312_gpio_get,
- .set = ar5312_gpio_set,
+/*
+ * gpiolib implementations. Original mask based methods preserved
+ */
+static int
+ar5312_gpio_get_value(struct gpio_chip *chip, unsigned gpio)
+{
+ struct ar231x_gpio_chip *gpch =
+ container_of(chip, struct ar231x_gpio_chip, chip);
+ u32 mask = 1 << gpio;
+ u32 rett;
+ if (!(gpch->valid_mask & mask))
+ return 0;
+ rett = ar5312_gpio_get(gpch->valid_mask);
+ return !!(rett & mask);
+}
+
+static void
+ar5312_gpio_set_value(struct gpio_chip *chip, unsigned gpio, int value)
+{
+ struct ar231x_gpio_chip *gpch =
+ container_of(chip, struct ar231x_gpio_chip, chip);
+ u32 mask = 1 << gpio;
+ if (!(gpch->valid_mask & mask))
+ return;
+ ar5312_gpio_set(mask, (!!value) * mask);
+}
+
+static int
+ar5312_gpio_direction_input(struct gpio_chip *chip, unsigned gpio)
+{
+ struct ar231x_gpio_chip *gpch =
+ container_of(chip, struct ar231x_gpio_chip, chip);
+ u32 mask = 1 << gpio;
+ if (!(gpch->valid_mask & mask))
+ return -ENXIO;
+ ar5312_gpio_set_output(mask, 0);
+ return 0;
+}
+static int
+ar5312_gpio_direction_output(struct gpio_chip *chip, unsigned gpio, int value)
+{
+ struct ar231x_gpio_chip *gpch =
+ container_of(chip, struct ar231x_gpio_chip, chip);
+ u32 mask = 1 << gpio;
+ if (!(gpch->valid_mask & mask))
+ return -ENXIO;
+ ar5312_gpio_set_output(mask, mask);
+ ar5312_gpio_set(mask, (!!value) * mask);
+ return 0;
+}
+
+static struct ar231x_gpio_chip ar5312_gpio_chip = {
+ .valid_mask = (1 << 22) - 1,
+ .chip = {
+ .label = "ar5312-gpio",
+ .direction_input = ar5312_gpio_direction_input,
+ .direction_output = ar5312_gpio_direction_output,
+ .set = ar5312_gpio_set_value,
+ .get = ar5312_gpio_get_value,
+ .base = 0,
+ .ngpio = AR531X_GPIO_IRQ_COUNT, // 22
+ }
};
+// end of gpiolib
+
static struct physmap_flash_data ar5312_flash_data = {
.width = 2,
};
@@ -486,6 +533,22 @@ ar5312_time_init(void)
mips_hpt_frequency = ar5312_cpu_frequency() / 2;
}
+int __init
+ar5312_gpio_init(void)
+{
+ int ret;
+ struct ar231x_gpio_chip *gpch;
+ gpch = &ar5312_gpio_chip;
+ ret = gpiochip_add(&gpch->chip);
+ if (ret) {
+ printk(KERN_ERR "%s: failed to add gpiochip\n",
+ gpch->chip.label);
+ return ret;
+ }
+ printk(KERN_INFO "%s: registered %d GPIOs\n",
+ gpch->chip.label, gpch->chip.ngpio);
+ return ret;
+}
void __init
ar5312_prom_init(void)
@@ -509,7 +572,7 @@ ar5312_prom_init(void)
devid >>= AR531X_REV_WMAC_MIN_S;
devid &= AR531X_REV_CHIP;
ar231x_board.devid = (u16) devid;
- ar231x_gpiodev = &ar5312_gpiodev;
+ ar5312_gpio_init();
}
void __init
--- a/arch/mips/ar231x/devices.c
+++ b/arch/mips/ar231x/devices.c
@@ -12,8 +12,6 @@
struct ar231x_board_config ar231x_board;
int ar231x_devtype = DEV_TYPE_UNKNOWN;
-const struct ar231x_gpiodev *ar231x_gpiodev;
-EXPORT_SYMBOL(ar231x_gpiodev);
static struct resource ar231x_eth0_res[] = {
{
--- a/arch/mips/ar231x/devices.h
+++ b/arch/mips/ar231x/devices.h
@@ -1,5 +1,6 @@
#ifndef __AR231X_DEVICES_H
#define __AR231X_DEVICES_H
+#include <linux/gpio.h>
enum {
/* handled by ar5312.c */
@@ -34,4 +35,8 @@ static inline bool is_5312(void)
return !is_2315();
}
+struct ar231x_gpio_chip {
+ u32 valid_mask;
+ struct gpio_chip chip;
+};
#endif
--- a/arch/mips/ar231x/reset.c
+++ b/arch/mips/ar231x/reset.c
@@ -6,11 +6,11 @@
#include <linux/workqueue.h>
#include <linux/skbuff.h>
#include <linux/netlink.h>
+#include <linux/gpio.h>
#include <net/sock.h>
#include <asm/uaccess.h>
#include <ar231x_platform.h>
#include <ar231x.h>
-#include <gpio.h>
#include "devices.h"
#define AR531X_RESET_GPIO_IRQ (AR531X_GPIO_IRQ(ar231x_board.config->resetConfigGpio))
@@ -85,13 +85,12 @@ static void
reset_button_poll(unsigned long unused)
{
struct event_t *event;
- int gpio = ~0;
+ int gpio = 0;
if(!no_release_workaround)
return;
- gpio = ar231x_gpiodev->get();
- gpio &= (1 << (AR531X_RESET_GPIO_IRQ - AR531X_GPIO_IRQ_BASE));
+ gpio = gpio_get_value(AR531X_RESET_GPIO_IRQ - AR531X_GPIO_IRQ_BASE);
if(gpio) {
rst_button_timer.expires = jiffies + (HZ / 4);
add_timer(&rst_button_timer);
@@ -113,7 +112,7 @@ button_handler(int irq, void *dev_id)
{
static int pressed = 0;
struct event_t *event;
- u32 gpio = ~0;
+ u32 gpio = 0;
event = (struct event_t *) kzalloc(sizeof(struct event_t), GFP_ATOMIC);
if (!event)
@@ -121,7 +120,7 @@ button_handler(int irq, void *dev_id)
pressed = !pressed;
- gpio = ar231x_gpiodev->get() & (1 << (irq - AR531X_GPIO_IRQ_BASE));
+ gpio = gpio_get_value(irq - AR531X_GPIO_IRQ_BASE);
event->set = gpio;
if(!event->set)
--- a/arch/mips/include/asm/mach-ar231x/gpio.h
+++ b/arch/mips/include/asm/mach-ar231x/gpio.h
@@ -3,66 +3,15 @@
#include <ar231x.h>
-struct ar231x_gpiodev {
- u32 valid_mask;
- u32 (*get_output)(void);
- u32 (*set_output)(u32 mask, u32 val);
- u32 (*get)(void);
- u32 (*set)(u32 mask, u32 val);
-};
-
-extern const struct ar231x_gpiodev *ar231x_gpiodev;
+#define gpio_get_value __gpio_get_value
+#define gpio_set_value __gpio_set_value
+#define gpio_cansleep __gpio_cansleep
/*
* Wrappers for the generic GPIO layer
*/
-static inline int gpio_direction_input(unsigned gpio) {
- u32 mask = 1 << gpio;
-
- if (!(ar231x_gpiodev->valid_mask & mask))
- return -ENXIO;
-
- ar231x_gpiodev->set_output(mask, 0);
- return 0;
-}
-
-static inline void gpio_set_value(unsigned gpio, int value) {
- u32 mask = 1 << gpio;
-
- if (!(ar231x_gpiodev->valid_mask & mask))
- return;
-
- ar231x_gpiodev->set(mask, (!!value) * mask);
-}
-
-static inline int gpio_direction_output(unsigned gpio, int value) {
- u32 mask = 1 << gpio;
-
- if (!(ar231x_gpiodev->valid_mask & mask))
- return -ENXIO;
-
- ar231x_gpiodev->set_output(mask, mask);
- ar231x_gpiodev->set(mask, (!!value) * mask);
- return 0;
-}
-
-/* Reads the gpio pin. Unchecked function */
-static inline int gpio_get_value(unsigned gpio) {
- u32 mask = 1 << gpio;
-
- if (!(ar231x_gpiodev->valid_mask & mask))
- return 0;
-
- return !!(ar231x_gpiodev->get() & mask);
-}
-
-static inline int gpio_request(unsigned gpio, const char *label) {
- return 0;
-}
-
-static inline void gpio_free(unsigned gpio) {
-}
+/* not sure if these are used? */
/* Returns IRQ to attach for gpio. Unchecked function */
static inline int gpio_to_irq(unsigned gpio) {
@@ -74,11 +23,6 @@ static inline int irq_to_gpio(unsigned i
return (irq - (AR531X_GPIO_IRQ(0)));
}
-static inline int gpio_set_debounce(unsigned gpio, unsigned debounce)
-{
- return -ENOSYS;
-}
-
#include <asm-generic/gpio.h> /* cansleep wrappers */
#endif