MIPS: Au1000: convert to using gpiolib
This patch converts the GPIO board code to use gpiolib. Signed-off-by: Florian Fainelli <florian@openwrt.org> Signed-off-by: Ralf Baechle <ralf@linux-mips.org>
This commit is contained in:
committed by
Ralf Baechle
parent
12e22e8e60
commit
47c969ee54
@@ -135,3 +135,4 @@ config SOC_AU1X00
|
|||||||
select SYS_SUPPORTS_32BIT_KERNEL
|
select SYS_SUPPORTS_32BIT_KERNEL
|
||||||
select SYS_SUPPORTS_APM_EMULATION
|
select SYS_SUPPORTS_APM_EMULATION
|
||||||
select GENERIC_HARDIRQS_NO__DO_IRQ
|
select GENERIC_HARDIRQS_NO__DO_IRQ
|
||||||
|
select ARCH_REQUIRE_GPIOLIB
|
||||||
|
@@ -1,5 +1,5 @@
|
|||||||
/*
|
/*
|
||||||
* Copyright (C) 2007, OpenWrt.org, Florian Fainelli <florian@openwrt.org>
|
* Copyright (C) 2007-2009, OpenWrt.org, Florian Fainelli <florian@openwrt.org>
|
||||||
* Architecture specific GPIO support
|
* Architecture specific GPIO support
|
||||||
*
|
*
|
||||||
* This program is free software; you can redistribute it and/or modify it
|
* This program is free software; you can redistribute it and/or modify it
|
||||||
@@ -27,122 +27,175 @@
|
|||||||
* others have a second one : GPIO2
|
* others have a second one : GPIO2
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
#include <linux/kernel.h>
|
||||||
#include <linux/module.h>
|
#include <linux/module.h>
|
||||||
|
#include <linux/types.h>
|
||||||
|
#include <linux/platform_device.h>
|
||||||
|
#include <linux/gpio.h>
|
||||||
|
|
||||||
#include <asm/mach-au1x00/au1000.h>
|
#include <asm/mach-au1x00/au1000.h>
|
||||||
#include <asm/gpio.h>
|
#include <asm/gpio.h>
|
||||||
|
|
||||||
#define gpio1 sys
|
struct au1000_gpio_chip {
|
||||||
|
struct gpio_chip chip;
|
||||||
|
void __iomem *regbase;
|
||||||
|
};
|
||||||
|
|
||||||
#if !defined(CONFIG_SOC_AU1000)
|
#if !defined(CONFIG_SOC_AU1000)
|
||||||
|
static int au1000_gpio2_get(struct gpio_chip *chip, unsigned offset)
|
||||||
static struct au1x00_gpio2 *const gpio2 = (struct au1x00_gpio2 *) GPIO2_BASE;
|
|
||||||
#define GPIO2_OUTPUT_ENABLE_MASK 0x00010000
|
|
||||||
|
|
||||||
static int au1xxx_gpio2_read(unsigned gpio)
|
|
||||||
{
|
{
|
||||||
gpio -= AU1XXX_GPIO_BASE;
|
u32 mask = 1 << offset;
|
||||||
return ((gpio2->pinstate >> gpio) & 0x01);
|
struct au1000_gpio_chip *gpch;
|
||||||
|
|
||||||
|
gpch = container_of(chip, struct au1000_gpio_chip, chip);
|
||||||
|
return readl(gpch->regbase + AU1000_GPIO2_ST) & mask;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void au1xxx_gpio2_write(unsigned gpio, int value)
|
static void au1000_gpio2_set(struct gpio_chip *chip,
|
||||||
|
unsigned offset, int value)
|
||||||
{
|
{
|
||||||
gpio -= AU1XXX_GPIO_BASE;
|
u32 mask = ((GPIO2_OUT_EN_MASK << offset) | (!!value << offset));
|
||||||
|
struct au1000_gpio_chip *gpch;
|
||||||
|
unsigned long flags;
|
||||||
|
|
||||||
gpio2->output = (GPIO2_OUTPUT_ENABLE_MASK << gpio) | ((!!value) << gpio);
|
gpch = container_of(chip, struct au1000_gpio_chip, chip);
|
||||||
|
|
||||||
|
local_irq_save(flags);
|
||||||
|
writel(mask, gpch->regbase + AU1000_GPIO2_OUT);
|
||||||
|
local_irq_restore(flags);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int au1xxx_gpio2_direction_input(unsigned gpio)
|
static int au1000_gpio2_direction_input(struct gpio_chip *chip, unsigned offset)
|
||||||
{
|
{
|
||||||
gpio -= AU1XXX_GPIO_BASE;
|
u32 mask = 1 << offset;
|
||||||
gpio2->dir &= ~(0x01 << gpio);
|
u32 tmp;
|
||||||
|
struct au1000_gpio_chip *gpch;
|
||||||
|
unsigned long flags;
|
||||||
|
|
||||||
|
gpch = container_of(chip, struct au1000_gpio_chip, chip);
|
||||||
|
|
||||||
|
local_irq_save(flags);
|
||||||
|
tmp = readl(gpch->regbase + AU1000_GPIO2_DIR);
|
||||||
|
tmp &= ~mask;
|
||||||
|
writel(tmp, gpch->regbase + AU1000_GPIO2_DIR);
|
||||||
|
local_irq_restore(flags);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int au1xxx_gpio2_direction_output(unsigned gpio, int value)
|
static int au1000_gpio2_direction_output(struct gpio_chip *chip,
|
||||||
|
unsigned offset, int value)
|
||||||
{
|
{
|
||||||
gpio -= AU1XXX_GPIO_BASE;
|
u32 mask = 1 << offset;
|
||||||
gpio2->dir |= 0x01 << gpio;
|
u32 out_mask = ((GPIO2_OUT_EN_MASK << offset) | (!!value << offset));
|
||||||
gpio2->output = (GPIO2_OUTPUT_ENABLE_MASK << gpio) | ((!!value) << gpio);
|
u32 tmp;
|
||||||
|
struct au1000_gpio_chip *gpch;
|
||||||
|
unsigned long flags;
|
||||||
|
|
||||||
|
gpch = container_of(chip, struct au1000_gpio_chip, chip);
|
||||||
|
|
||||||
|
local_irq_save(flags);
|
||||||
|
tmp = readl(gpch->regbase + AU1000_GPIO2_DIR);
|
||||||
|
tmp |= mask;
|
||||||
|
writel(tmp, gpch->regbase + AU1000_GPIO2_DIR);
|
||||||
|
writel(out_mask, gpch->regbase + AU1000_GPIO2_OUT);
|
||||||
|
local_irq_restore(flags);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif /* !defined(CONFIG_SOC_AU1000) */
|
#endif /* !defined(CONFIG_SOC_AU1000) */
|
||||||
|
|
||||||
static int au1xxx_gpio1_read(unsigned gpio)
|
static int au1000_gpio1_get(struct gpio_chip *chip, unsigned offset)
|
||||||
{
|
{
|
||||||
return (gpio1->pinstaterd >> gpio) & 0x01;
|
u32 mask = 1 << offset;
|
||||||
|
struct au1000_gpio_chip *gpch;
|
||||||
|
|
||||||
|
gpch = container_of(chip, struct au1000_gpio_chip, chip);
|
||||||
|
return readl(gpch->regbase + AU1000_GPIO1_ST) & mask;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void au1xxx_gpio1_write(unsigned gpio, int value)
|
static void au1000_gpio1_set(struct gpio_chip *chip,
|
||||||
|
unsigned offset, int value)
|
||||||
{
|
{
|
||||||
|
u32 mask = 1 << offset;
|
||||||
|
u32 reg_offset;
|
||||||
|
struct au1000_gpio_chip *gpch;
|
||||||
|
unsigned long flags;
|
||||||
|
|
||||||
|
gpch = container_of(chip, struct au1000_gpio_chip, chip);
|
||||||
|
|
||||||
if (value)
|
if (value)
|
||||||
gpio1->outputset = (0x01 << gpio);
|
reg_offset = AU1000_GPIO1_OUT;
|
||||||
else
|
else
|
||||||
/* Output a zero */
|
reg_offset = AU1000_GPIO1_CLR;
|
||||||
gpio1->outputclr = (0x01 << gpio);
|
|
||||||
|
local_irq_save(flags);
|
||||||
|
writel(mask, gpch->regbase + reg_offset);
|
||||||
|
local_irq_restore(flags);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int au1xxx_gpio1_direction_input(unsigned gpio)
|
static int au1000_gpio1_direction_input(struct gpio_chip *chip, unsigned offset)
|
||||||
{
|
{
|
||||||
gpio1->pininputen = (0x01 << gpio);
|
u32 mask = 1 << offset;
|
||||||
|
struct au1000_gpio_chip *gpch;
|
||||||
|
|
||||||
|
gpch = container_of(chip, struct au1000_gpio_chip, chip);
|
||||||
|
writel(mask, gpch->regbase + AU1000_GPIO1_ST);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int au1xxx_gpio1_direction_output(unsigned gpio, int value)
|
static int au1000_gpio1_direction_output(struct gpio_chip *chip,
|
||||||
|
unsigned offset, int value)
|
||||||
{
|
{
|
||||||
gpio1->trioutclr = (0x01 & gpio);
|
u32 mask = 1 << offset;
|
||||||
au1xxx_gpio1_write(gpio, value);
|
struct au1000_gpio_chip *gpch;
|
||||||
|
|
||||||
|
gpch = container_of(chip, struct au1000_gpio_chip, chip);
|
||||||
|
|
||||||
|
writel(mask, gpch->regbase + AU1000_GPIO1_TRI_OUT);
|
||||||
|
au1000_gpio1_set(chip, offset, value);
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
int au1xxx_gpio_get_value(unsigned gpio)
|
struct au1000_gpio_chip au1000_gpio_chip[] = {
|
||||||
{
|
[0] = {
|
||||||
if (gpio >= AU1XXX_GPIO_BASE)
|
.regbase = (void __iomem *)SYS_BASE,
|
||||||
#if defined(CONFIG_SOC_AU1000)
|
.chip = {
|
||||||
return 0;
|
.label = "au1000-gpio1",
|
||||||
#else
|
.direction_input = au1000_gpio1_direction_input,
|
||||||
return au1xxx_gpio2_read(gpio);
|
.direction_output = au1000_gpio1_direction_output,
|
||||||
|
.get = au1000_gpio1_get,
|
||||||
|
.set = au1000_gpio1_set,
|
||||||
|
.base = 0,
|
||||||
|
.ngpio = 32,
|
||||||
|
},
|
||||||
|
},
|
||||||
|
#if !defined(CONFIG_SOC_AU1000)
|
||||||
|
[1] = {
|
||||||
|
.regbase = (void __iomem *)GPIO2_BASE,
|
||||||
|
.chip = {
|
||||||
|
.label = "au1000-gpio2",
|
||||||
|
.direction_input = au1000_gpio2_direction_input,
|
||||||
|
.direction_output = au1000_gpio2_direction_output,
|
||||||
|
.get = au1000_gpio2_get,
|
||||||
|
.set = au1000_gpio2_set,
|
||||||
|
.base = AU1XXX_GPIO_BASE,
|
||||||
|
.ngpio = 32,
|
||||||
|
},
|
||||||
|
},
|
||||||
#endif
|
#endif
|
||||||
else
|
};
|
||||||
return au1xxx_gpio1_read(gpio);
|
|
||||||
}
|
|
||||||
EXPORT_SYMBOL(au1xxx_gpio_get_value);
|
|
||||||
|
|
||||||
void au1xxx_gpio_set_value(unsigned gpio, int value)
|
static int __init au1000_gpio_init(void)
|
||||||
{
|
{
|
||||||
if (gpio >= AU1XXX_GPIO_BASE)
|
gpiochip_add(&au1000_gpio_chip[0].chip);
|
||||||
#if defined(CONFIG_SOC_AU1000)
|
#if !defined(CONFIG_SOC_AU1000)
|
||||||
;
|
gpiochip_add(&au1000_gpio_chip[1].chip);
|
||||||
#else
|
|
||||||
au1xxx_gpio2_write(gpio, value);
|
|
||||||
#endif
|
|
||||||
else
|
|
||||||
au1xxx_gpio1_write(gpio, value);
|
|
||||||
}
|
|
||||||
EXPORT_SYMBOL(au1xxx_gpio_set_value);
|
|
||||||
|
|
||||||
int au1xxx_gpio_direction_input(unsigned gpio)
|
|
||||||
{
|
|
||||||
if (gpio >= AU1XXX_GPIO_BASE)
|
|
||||||
#if defined(CONFIG_SOC_AU1000)
|
|
||||||
return -ENODEV;
|
|
||||||
#else
|
|
||||||
return au1xxx_gpio2_direction_input(gpio);
|
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
return au1xxx_gpio1_direction_input(gpio);
|
return 0;
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL(au1xxx_gpio_direction_input);
|
arch_initcall(au1000_gpio_init);
|
||||||
|
|
||||||
int au1xxx_gpio_direction_output(unsigned gpio, int value)
|
|
||||||
{
|
|
||||||
if (gpio >= AU1XXX_GPIO_BASE)
|
|
||||||
#if defined(CONFIG_SOC_AU1000)
|
|
||||||
return -ENODEV;
|
|
||||||
#else
|
|
||||||
return au1xxx_gpio2_direction_output(gpio, value);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
return au1xxx_gpio1_direction_output(gpio, value);
|
|
||||||
}
|
|
||||||
EXPORT_SYMBOL(au1xxx_gpio_direction_output);
|
|
||||||
|
@@ -5,65 +5,29 @@
|
|||||||
|
|
||||||
#define AU1XXX_GPIO_BASE 200
|
#define AU1XXX_GPIO_BASE 200
|
||||||
|
|
||||||
struct au1x00_gpio2 {
|
/* GPIO bank 1 offsets */
|
||||||
u32 dir;
|
#define AU1000_GPIO1_TRI_OUT 0x0100
|
||||||
u32 reserved;
|
#define AU1000_GPIO1_OUT 0x0108
|
||||||
u32 output;
|
#define AU1000_GPIO1_ST 0x0110
|
||||||
u32 pinstate;
|
#define AU1000_GPIO1_CLR 0x010C
|
||||||
u32 inten;
|
|
||||||
u32 enable;
|
|
||||||
};
|
|
||||||
|
|
||||||
extern int au1xxx_gpio_get_value(unsigned gpio);
|
/* GPIO bank 2 offsets */
|
||||||
extern void au1xxx_gpio_set_value(unsigned gpio, int value);
|
#define AU1000_GPIO2_DIR 0x00
|
||||||
extern int au1xxx_gpio_direction_input(unsigned gpio);
|
#define AU1000_GPIO2_RSVD 0x04
|
||||||
extern int au1xxx_gpio_direction_output(unsigned gpio, int value);
|
#define AU1000_GPIO2_OUT 0x08
|
||||||
|
#define AU1000_GPIO2_ST 0x0C
|
||||||
|
#define AU1000_GPIO2_INT 0x10
|
||||||
|
#define AU1000_GPIO2_EN 0x14
|
||||||
|
|
||||||
|
#define GPIO2_OUT_EN_MASK 0x00010000
|
||||||
|
|
||||||
/* Wrappers for the arch-neutral GPIO API */
|
#define gpio_to_irq(gpio) NULL
|
||||||
|
|
||||||
static inline int gpio_request(unsigned gpio, const char *label)
|
#define gpio_get_value __gpio_get_value
|
||||||
{
|
#define gpio_set_value __gpio_set_value
|
||||||
/* Not yet implemented */
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void gpio_free(unsigned gpio)
|
#define gpio_cansleep __gpio_cansleep
|
||||||
{
|
|
||||||
/* Not yet implemented */
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline int gpio_direction_input(unsigned gpio)
|
|
||||||
{
|
|
||||||
return au1xxx_gpio_direction_input(gpio);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline int gpio_direction_output(unsigned gpio, int value)
|
|
||||||
{
|
|
||||||
return au1xxx_gpio_direction_output(gpio, value);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline int gpio_get_value(unsigned gpio)
|
|
||||||
{
|
|
||||||
return au1xxx_gpio_get_value(gpio);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline void gpio_set_value(unsigned gpio, int value)
|
|
||||||
{
|
|
||||||
au1xxx_gpio_set_value(gpio, value);
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline int gpio_to_irq(unsigned gpio)
|
|
||||||
{
|
|
||||||
return gpio;
|
|
||||||
}
|
|
||||||
|
|
||||||
static inline int irq_to_gpio(unsigned irq)
|
|
||||||
{
|
|
||||||
return irq;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* For cansleep */
|
|
||||||
#include <asm-generic/gpio.h>
|
#include <asm-generic/gpio.h>
|
||||||
|
|
||||||
#endif /* _AU1XXX_GPIO_H_ */
|
#endif /* _AU1XXX_GPIO_H_ */
|
||||||
|
Reference in New Issue
Block a user