ramips: setup GPIO chip functions on the fly
[openwrt/svn-archive/archive.git] / target / linux / ramips / files / arch / mips / ralink / common / gpio.c
1 /*
2 * Ralink SoC specific GPIO support
3 *
4 * Copyright (C) 2009-2011 Gabor Juhos <juhosg@openwrt.org>
5 *
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License version 2 as published
8 * by the Free Software Foundation.
9 */
10
11 #include <linux/init.h>
12 #include <linux/io.h>
13 #include <linux/spinlock.h>
14 #include <linux/gpio.h>
15
16 #include <ralink_soc.h>
17
18 #define GPIO0_REG_INT 0x00
19 #define GPIO0_REG_EDGE 0x04
20 #define GPIO0_REG_RENA 0x08
21 #define GPIO0_REG_FENA 0x0c
22 #define GPIO0_REG_DATA 0x20
23 #define GPIO0_REG_DIR 0x24
24 #define GPIO0_REG_POL 0x28
25 #define GPIO0_REG_SET 0x2c
26 #define GPIO0_REG_RESET 0x30
27 #define GPIO0_REG_TOGGLE 0x34
28
29 #define GPIO1_REG_INT 0x38
30 #define GPIO1_REG_EDGE 0x3c
31 #define GPIO1_REG_RENA 0x40
32 #define GPIO1_REG_FENA 0x44
33 #define GPIO1_REG_DATA 0x48
34 #define GPIO1_REG_DIR 0x4c
35 #define GPIO1_REG_POL 0x50
36 #define GPIO1_REG_SET 0x54
37 #define GPIO1_REG_RESET 0x58
38 #define GPIO1_REG_TOGGLE 0x5c
39
40 #define GPIO2_REG_INT 0x60
41 #define GPIO2_REG_EDGE 0x64
42 #define GPIO2_REG_RENA 0x68
43 #define GPIO2_REG_FENA 0x6c
44 #define GPIO2_REG_DATA 0x70
45 #define GPIO2_REG_DIR 0x74
46 #define GPIO2_REG_POL 0x78
47 #define GPIO2_REG_SET 0x7c
48 #define GPIO2_REG_RESET 0x80
49 #define GPIO2_REG_TOGGLE 0x84
50
51 enum ramips_pio_reg {
52 RAMIPS_GPIO_REG_INT, /* Interrupt status */
53 RAMIPS_GPIO_REG_EDGE,
54 RAMIPS_GPIO_REG_RENA,
55 RAMIPS_GPIO_REG_FENA,
56 RAMIPS_GPIO_REG_DATA,
57 RAMIPS_GPIO_REG_DIR, /* Direction, 0:in, 1: out */
58 RAMIPS_GPIO_REG_POL, /* Polarity, 0: normal, 1: invert */
59 RAMIPS_GPIO_REG_SET,
60 RAMIPS_GPIO_REG_RESET,
61 RAMIPS_GPIO_REG_TOGGLE,
62 RAMIPS_GPIO_REG_MAX
63 };
64
65 struct ramips_gpio_chip {
66 struct gpio_chip chip;
67 u8 regs[RAMIPS_GPIO_REG_MAX];
68 unsigned long map_base;
69 unsigned long map_size;
70
71 spinlock_t lock;
72 void __iomem *regs_base;
73 };
74
75 static inline struct ramips_gpio_chip *to_ramips_gpio(struct gpio_chip *chip)
76 {
77 struct ramips_gpio_chip *rg;
78
79 rg = container_of(chip, struct ramips_gpio_chip, chip);
80 return rg;
81 }
82
83 static inline void ramips_gpio_wr(struct ramips_gpio_chip *rg, u8 reg, u32 val)
84 {
85 __raw_writel(val, rg->regs_base + rg->regs[reg]);
86 }
87
88 static inline u32 ramips_gpio_rr(struct ramips_gpio_chip *rg, u8 reg)
89 {
90 return __raw_readl(rg->regs_base + rg->regs[reg]);
91 }
92
93 static int ramips_gpio_direction_input(struct gpio_chip *chip, unsigned offset)
94 {
95 struct ramips_gpio_chip *rg = to_ramips_gpio(chip);
96 unsigned long flags;
97 u32 t;
98
99 spin_lock_irqsave(&rg->lock, flags);
100 t = ramips_gpio_rr(rg, RAMIPS_GPIO_REG_DIR);
101 t &= ~(1 << offset);
102 ramips_gpio_wr(rg, RAMIPS_GPIO_REG_DIR, t);
103 spin_unlock_irqrestore(&rg->lock, flags);
104
105 return 0;
106 }
107
108 static int ramips_gpio_direction_output(struct gpio_chip *chip,
109 unsigned offset, int value)
110 {
111 struct ramips_gpio_chip *rg = to_ramips_gpio(chip);
112 unsigned long flags;
113 u32 reg;
114 u32 t;
115
116 reg = (value) ? RAMIPS_GPIO_REG_SET : RAMIPS_GPIO_REG_RESET;
117
118 spin_lock_irqsave(&rg->lock, flags);
119 ramips_gpio_wr(rg, reg, 1 << offset);
120
121 t = ramips_gpio_rr(rg, RAMIPS_GPIO_REG_DIR);
122 t |= 1 << offset;
123 ramips_gpio_wr(rg, RAMIPS_GPIO_REG_DIR, t);
124 spin_unlock_irqrestore(&rg->lock, flags);
125
126 return 0;
127 }
128
129 static void ramips_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
130 {
131 struct ramips_gpio_chip *rg = to_ramips_gpio(chip);
132 u32 reg;
133
134 reg = (value) ? RAMIPS_GPIO_REG_SET : RAMIPS_GPIO_REG_RESET;
135 ramips_gpio_wr(rg, reg, 1 << offset);
136 }
137
138 static int ramips_gpio_get(struct gpio_chip *chip, unsigned offset)
139 {
140 struct ramips_gpio_chip *rg = to_ramips_gpio(chip);
141 u32 t;
142
143 t = ramips_gpio_rr(rg, RAMIPS_GPIO_REG_DATA);
144 return !!(t & (1 << offset));
145 }
146
147 static struct ramips_gpio_chip ramips_gpio_chip0 = {
148 .chip = {
149 .label = "ramips-gpio0",
150 .base = 0,
151 .ngpio = RALINK_SOC_GPIO0_COUNT,
152 },
153 .regs = {
154 [RAMIPS_GPIO_REG_INT] = GPIO0_REG_INT,
155 [RAMIPS_GPIO_REG_EDGE] = GPIO0_REG_EDGE,
156 [RAMIPS_GPIO_REG_RENA] = GPIO0_REG_RENA,
157 [RAMIPS_GPIO_REG_FENA] = GPIO0_REG_FENA,
158 [RAMIPS_GPIO_REG_DATA] = GPIO0_REG_DATA,
159 [RAMIPS_GPIO_REG_DIR] = GPIO0_REG_DIR,
160 [RAMIPS_GPIO_REG_POL] = GPIO0_REG_POL,
161 [RAMIPS_GPIO_REG_SET] = GPIO0_REG_SET,
162 [RAMIPS_GPIO_REG_RESET] = GPIO0_REG_RESET,
163 [RAMIPS_GPIO_REG_TOGGLE] = GPIO0_REG_TOGGLE,
164 },
165 .map_base = RALINK_SOC_GPIO_BASE,
166 .map_size = PAGE_SIZE,
167 };
168
169 static struct ramips_gpio_chip ramips_gpio_chip1 = {
170 .chip = {
171 .label = "ramips-gpio1",
172 .base = 32,
173 .ngpio = RALINK_SOC_GPIO1_COUNT,
174 },
175 .regs = {
176 [RAMIPS_GPIO_REG_INT] = GPIO1_REG_INT,
177 [RAMIPS_GPIO_REG_EDGE] = GPIO1_REG_EDGE,
178 [RAMIPS_GPIO_REG_RENA] = GPIO1_REG_RENA,
179 [RAMIPS_GPIO_REG_FENA] = GPIO1_REG_FENA,
180 [RAMIPS_GPIO_REG_DATA] = GPIO1_REG_DATA,
181 [RAMIPS_GPIO_REG_DIR] = GPIO1_REG_DIR,
182 [RAMIPS_GPIO_REG_POL] = GPIO1_REG_POL,
183 [RAMIPS_GPIO_REG_SET] = GPIO1_REG_SET,
184 [RAMIPS_GPIO_REG_RESET] = GPIO1_REG_RESET,
185 [RAMIPS_GPIO_REG_TOGGLE] = GPIO1_REG_TOGGLE,
186 },
187 .map_base = RALINK_SOC_GPIO_BASE,
188 .map_size = PAGE_SIZE,
189 };
190
191 static struct ramips_gpio_chip ramips_gpio_chip2 = {
192 .chip = {
193 .label = "ramips-gpio2",
194 .base = 64,
195 .ngpio = RALINK_SOC_GPIO2_COUNT,
196 },
197 .regs = {
198 [RAMIPS_GPIO_REG_INT] = GPIO2_REG_INT,
199 [RAMIPS_GPIO_REG_EDGE] = GPIO2_REG_EDGE,
200 [RAMIPS_GPIO_REG_RENA] = GPIO2_REG_RENA,
201 [RAMIPS_GPIO_REG_FENA] = GPIO2_REG_FENA,
202 [RAMIPS_GPIO_REG_DATA] = GPIO2_REG_DATA,
203 [RAMIPS_GPIO_REG_DIR] = GPIO2_REG_DIR,
204 [RAMIPS_GPIO_REG_POL] = GPIO2_REG_POL,
205 [RAMIPS_GPIO_REG_SET] = GPIO2_REG_SET,
206 [RAMIPS_GPIO_REG_RESET] = GPIO2_REG_RESET,
207 [RAMIPS_GPIO_REG_TOGGLE] = GPIO2_REG_TOGGLE,
208 },
209 .map_base = RALINK_SOC_GPIO_BASE,
210 .map_size = PAGE_SIZE,
211 };
212
213 static __init void ramips_gpio_chip_add(struct ramips_gpio_chip *rg)
214 {
215 spin_lock_init(&rg->lock);
216
217 rg->regs_base = ioremap(rg->map_base, rg->map_size);
218
219 rg->chip.direction_input = ramips_gpio_direction_input;
220 rg->chip.direction_output = ramips_gpio_direction_output;
221 rg->chip.get = ramips_gpio_get;
222 rg->chip.set = ramips_gpio_set;
223
224 /* set polarity to low for all lines */
225 ramips_gpio_wr(rg, RAMIPS_GPIO_REG_POL, 0);
226
227 gpiochip_add(&rg->chip);
228 }
229
230 __init int ramips_gpio_init(void)
231 {
232 ramips_gpio_chip_add(&ramips_gpio_chip0);
233 ramips_gpio_chip_add(&ramips_gpio_chip1);
234 ramips_gpio_chip_add(&ramips_gpio_chip2);
235
236 return 0;
237 }