|
|
|
@ -22,24 +22,37 @@ |
|
|
|
|
|
|
|
|
|
#define AR7_GPIO_MAX 32 |
|
|
|
|
|
|
|
|
|
extern int gpio_request(unsigned gpio, char *label); |
|
|
|
|
extern int gpio_request(unsigned gpio, const char *label); |
|
|
|
|
extern void gpio_free(unsigned gpio); |
|
|
|
|
|
|
|
|
|
/* Common GPIO layer */ |
|
|
|
|
static inline int gpio_direction_input(unsigned gpio) |
|
|
|
|
static inline int gpio_get_value(unsigned gpio) |
|
|
|
|
{ |
|
|
|
|
void __iomem *gpio_dir = |
|
|
|
|
(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_DIR); |
|
|
|
|
void __iomem *gpio_in = |
|
|
|
|
(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_INPUT); |
|
|
|
|
|
|
|
|
|
if (gpio >= AR7_GPIO_MAX) |
|
|
|
|
return -EINVAL; |
|
|
|
|
|
|
|
|
|
writel(readl(gpio_dir) | (1 << gpio), gpio_dir); |
|
|
|
|
return ((readl(gpio_in) & (1 << gpio)) != 0); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
return 0; |
|
|
|
|
static inline void gpio_set_value(unsigned gpio, int value) |
|
|
|
|
{ |
|
|
|
|
void __iomem *gpio_out = |
|
|
|
|
(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_OUTPUT); |
|
|
|
|
volatile unsigned tmp; |
|
|
|
|
|
|
|
|
|
if (gpio >= AR7_GPIO_MAX) |
|
|
|
|
return; |
|
|
|
|
|
|
|
|
|
tmp = readl(gpio_out) & ~(1 << gpio); |
|
|
|
|
if (value) |
|
|
|
|
tmp |= 1 << gpio; |
|
|
|
|
writel(tmp, gpio_out); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static inline int gpio_direction_output(unsigned gpio) |
|
|
|
|
static inline int gpio_direction_input(unsigned gpio) |
|
|
|
|
{ |
|
|
|
|
void __iomem *gpio_dir = |
|
|
|
|
(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_DIR); |
|
|
|
@ -47,35 +60,23 @@ static inline int gpio_direction_output(unsigned gpio) |
|
|
|
|
if (gpio >= AR7_GPIO_MAX) |
|
|
|
|
return -EINVAL; |
|
|
|
|
|
|
|
|
|
writel(readl(gpio_dir) & ~(1 << gpio), gpio_dir); |
|
|
|
|
writel(readl(gpio_dir) | (1 << gpio), gpio_dir); |
|
|
|
|
|
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static inline int gpio_get_value(unsigned gpio) |
|
|
|
|
static inline int gpio_direction_output(unsigned gpio, int value) |
|
|
|
|
{ |
|
|
|
|
void __iomem *gpio_in = |
|
|
|
|
(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_INPUT); |
|
|
|
|
void __iomem *gpio_dir = |
|
|
|
|
(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_DIR); |
|
|
|
|
|
|
|
|
|
if (gpio >= AR7_GPIO_MAX) |
|
|
|
|
return -EINVAL; |
|
|
|
|
|
|
|
|
|
return ((readl(gpio_in) & (1 << gpio)) != 0); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static inline void gpio_set_value(unsigned gpio, int value) |
|
|
|
|
{ |
|
|
|
|
void __iomem *gpio_out = |
|
|
|
|
(void __iomem *)KSEG1ADDR(AR7_REGS_GPIO + AR7_GPIO_OUTPUT); |
|
|
|
|
volatile unsigned tmp; |
|
|
|
|
|
|
|
|
|
if (gpio >= AR7_GPIO_MAX) |
|
|
|
|
return; |
|
|
|
|
gpio_set_value(gpio, value); |
|
|
|
|
writel(readl(gpio_dir) & ~(1 << gpio), gpio_dir); |
|
|
|
|
|
|
|
|
|
tmp = readl(gpio_out) & ~(1 << gpio); |
|
|
|
|
if (value) |
|
|
|
|
tmp |= 1 << gpio; |
|
|
|
|
writel(tmp, gpio_out); |
|
|
|
|
return 0; |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
static inline int gpio_to_irq(unsigned gpio) |
|
|
|
|