powerpc: Delete __cpuinit usage from all users
[linux/fpc-iii.git] / arch / mips / ath79 / gpio.c
blob8d025b028bb1558b58c43b7ead17dcfd9263786a
1 /*
2 * Atheros AR71XX/AR724X/AR913X GPIO API support
4 * Copyright (C) 2010-2011 Jaiganesh Narayanan <jnarayanan@atheros.com>
5 * Copyright (C) 2008-2011 Gabor Juhos <juhosg@openwrt.org>
6 * Copyright (C) 2008 Imre Kaloz <kaloz@openwrt.org>
8 * Parts of this file are based on Atheros' 2.6.15/2.6.31 BSP
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License version 2 as published
12 * by the Free Software Foundation.
15 #include <linux/kernel.h>
16 #include <linux/init.h>
17 #include <linux/module.h>
18 #include <linux/types.h>
19 #include <linux/spinlock.h>
20 #include <linux/io.h>
21 #include <linux/ioport.h>
22 #include <linux/gpio.h>
24 #include <asm/mach-ath79/ar71xx_regs.h>
25 #include <asm/mach-ath79/ath79.h>
26 #include "common.h"
28 static void __iomem *ath79_gpio_base;
29 static unsigned long ath79_gpio_count;
30 static DEFINE_SPINLOCK(ath79_gpio_lock);
32 static void __ath79_gpio_set_value(unsigned gpio, int value)
34 void __iomem *base = ath79_gpio_base;
36 if (value)
37 __raw_writel(1 << gpio, base + AR71XX_GPIO_REG_SET);
38 else
39 __raw_writel(1 << gpio, base + AR71XX_GPIO_REG_CLEAR);
42 static int __ath79_gpio_get_value(unsigned gpio)
44 return (__raw_readl(ath79_gpio_base + AR71XX_GPIO_REG_IN) >> gpio) & 1;
47 static int ath79_gpio_get_value(struct gpio_chip *chip, unsigned offset)
49 return __ath79_gpio_get_value(offset);
52 static void ath79_gpio_set_value(struct gpio_chip *chip,
53 unsigned offset, int value)
55 __ath79_gpio_set_value(offset, value);
58 static int ath79_gpio_direction_input(struct gpio_chip *chip,
59 unsigned offset)
61 void __iomem *base = ath79_gpio_base;
62 unsigned long flags;
64 spin_lock_irqsave(&ath79_gpio_lock, flags);
66 __raw_writel(__raw_readl(base + AR71XX_GPIO_REG_OE) & ~(1 << offset),
67 base + AR71XX_GPIO_REG_OE);
69 spin_unlock_irqrestore(&ath79_gpio_lock, flags);
71 return 0;
74 static int ath79_gpio_direction_output(struct gpio_chip *chip,
75 unsigned offset, int value)
77 void __iomem *base = ath79_gpio_base;
78 unsigned long flags;
80 spin_lock_irqsave(&ath79_gpio_lock, flags);
82 if (value)
83 __raw_writel(1 << offset, base + AR71XX_GPIO_REG_SET);
84 else
85 __raw_writel(1 << offset, base + AR71XX_GPIO_REG_CLEAR);
87 __raw_writel(__raw_readl(base + AR71XX_GPIO_REG_OE) | (1 << offset),
88 base + AR71XX_GPIO_REG_OE);
90 spin_unlock_irqrestore(&ath79_gpio_lock, flags);
92 return 0;
95 static int ar934x_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
97 void __iomem *base = ath79_gpio_base;
98 unsigned long flags;
100 spin_lock_irqsave(&ath79_gpio_lock, flags);
102 __raw_writel(__raw_readl(base + AR71XX_GPIO_REG_OE) | (1 << offset),
103 base + AR71XX_GPIO_REG_OE);
105 spin_unlock_irqrestore(&ath79_gpio_lock, flags);
107 return 0;
110 static int ar934x_gpio_direction_output(struct gpio_chip *chip, unsigned offset,
111 int value)
113 void __iomem *base = ath79_gpio_base;
114 unsigned long flags;
116 spin_lock_irqsave(&ath79_gpio_lock, flags);
118 if (value)
119 __raw_writel(1 << offset, base + AR71XX_GPIO_REG_SET);
120 else
121 __raw_writel(1 << offset, base + AR71XX_GPIO_REG_CLEAR);
123 __raw_writel(__raw_readl(base + AR71XX_GPIO_REG_OE) & ~(1 << offset),
124 base + AR71XX_GPIO_REG_OE);
126 spin_unlock_irqrestore(&ath79_gpio_lock, flags);
128 return 0;
131 static struct gpio_chip ath79_gpio_chip = {
132 .label = "ath79",
133 .get = ath79_gpio_get_value,
134 .set = ath79_gpio_set_value,
135 .direction_input = ath79_gpio_direction_input,
136 .direction_output = ath79_gpio_direction_output,
137 .base = 0,
140 static void __iomem *ath79_gpio_get_function_reg(void)
142 u32 reg = 0;
144 if (soc_is_ar71xx() ||
145 soc_is_ar724x() ||
146 soc_is_ar913x() ||
147 soc_is_ar933x())
148 reg = AR71XX_GPIO_REG_FUNC;
149 else if (soc_is_ar934x())
150 reg = AR934X_GPIO_REG_FUNC;
151 else
152 BUG();
154 return ath79_gpio_base + reg;
157 void ath79_gpio_function_setup(u32 set, u32 clear)
159 void __iomem *reg = ath79_gpio_get_function_reg();
160 unsigned long flags;
162 spin_lock_irqsave(&ath79_gpio_lock, flags);
164 __raw_writel((__raw_readl(reg) & ~clear) | set, reg);
165 /* flush write */
166 __raw_readl(reg);
168 spin_unlock_irqrestore(&ath79_gpio_lock, flags);
171 void ath79_gpio_function_enable(u32 mask)
173 ath79_gpio_function_setup(mask, 0);
176 void ath79_gpio_function_disable(u32 mask)
178 ath79_gpio_function_setup(0, mask);
181 void __init ath79_gpio_init(void)
183 int err;
185 if (soc_is_ar71xx())
186 ath79_gpio_count = AR71XX_GPIO_COUNT;
187 else if (soc_is_ar7240())
188 ath79_gpio_count = AR7240_GPIO_COUNT;
189 else if (soc_is_ar7241() || soc_is_ar7242())
190 ath79_gpio_count = AR7241_GPIO_COUNT;
191 else if (soc_is_ar913x())
192 ath79_gpio_count = AR913X_GPIO_COUNT;
193 else if (soc_is_ar933x())
194 ath79_gpio_count = AR933X_GPIO_COUNT;
195 else if (soc_is_ar934x())
196 ath79_gpio_count = AR934X_GPIO_COUNT;
197 else if (soc_is_qca955x())
198 ath79_gpio_count = QCA955X_GPIO_COUNT;
199 else
200 BUG();
202 ath79_gpio_base = ioremap_nocache(AR71XX_GPIO_BASE, AR71XX_GPIO_SIZE);
203 ath79_gpio_chip.ngpio = ath79_gpio_count;
204 if (soc_is_ar934x() || soc_is_qca955x()) {
205 ath79_gpio_chip.direction_input = ar934x_gpio_direction_input;
206 ath79_gpio_chip.direction_output = ar934x_gpio_direction_output;
209 err = gpiochip_add(&ath79_gpio_chip);
210 if (err)
211 panic("cannot add AR71xx GPIO chip, error=%d", err);
214 int gpio_get_value(unsigned gpio)
216 if (gpio < ath79_gpio_count)
217 return __ath79_gpio_get_value(gpio);
219 return __gpio_get_value(gpio);
221 EXPORT_SYMBOL(gpio_get_value);
223 void gpio_set_value(unsigned gpio, int value)
225 if (gpio < ath79_gpio_count)
226 __ath79_gpio_set_value(gpio, value);
227 else
228 __gpio_set_value(gpio, value);
230 EXPORT_SYMBOL(gpio_set_value);
232 int gpio_to_irq(unsigned gpio)
234 /* FIXME */
235 return -EINVAL;
237 EXPORT_SYMBOL(gpio_to_irq);
239 int irq_to_gpio(unsigned irq)
241 /* FIXME */
242 return -EINVAL;
244 EXPORT_SYMBOL(irq_to_gpio);