diff options
Diffstat (limited to 'arch/arm/mach-s5p6440/gpio.c')
-rw-r--r-- | arch/arm/mach-s5p6440/gpio.c | 322 |
1 files changed, 322 insertions, 0 deletions
diff --git a/arch/arm/mach-s5p6440/gpio.c b/arch/arm/mach-s5p6440/gpio.c new file mode 100644 index 000000000000..b0ea741177ad --- /dev/null +++ b/arch/arm/mach-s5p6440/gpio.c | |||
@@ -0,0 +1,322 @@ | |||
1 | /* arch/arm/mach-s5p6440/gpio.c | ||
2 | * | ||
3 | * Copyright (c) 2009 Samsung Electronics Co., Ltd. | ||
4 | * http://www.samsung.com/ | ||
5 | * | ||
6 | * S5P6440 - GPIOlib support | ||
7 | * | ||
8 | * This program is free software; you can redistribute it and/or modify | ||
9 | * it under the terms of the GNU General Public License version 2 as | ||
10 | * published by the Free Software Foundation. | ||
11 | */ | ||
12 | |||
13 | #include <linux/kernel.h> | ||
14 | #include <linux/irq.h> | ||
15 | #include <linux/io.h> | ||
16 | #include <mach/map.h> | ||
17 | #include <mach/gpio.h> | ||
18 | #include <mach/regs-gpio.h> | ||
19 | #include <plat/gpio-core.h> | ||
20 | #include <plat/gpio-cfg.h> | ||
21 | #include <plat/gpio-cfg-helpers.h> | ||
22 | |||
23 | /* GPIO bank summary: | ||
24 | * | ||
25 | * Bank GPIOs Style SlpCon ExtInt Group | ||
26 | * A 6 4Bit Yes 1 | ||
27 | * B 7 4Bit Yes 1 | ||
28 | * C 8 4Bit Yes 2 | ||
29 | * F 2 2Bit Yes 4 [1] | ||
30 | * G 7 4Bit Yes 5 | ||
31 | * H 10 4Bit[2] Yes 6 | ||
32 | * I 16 2Bit Yes None | ||
33 | * J 12 2Bit Yes None | ||
34 | * N 16 2Bit No IRQ_EINT | ||
35 | * P 8 2Bit Yes 8 | ||
36 | * R 15 4Bit[2] Yes 8 | ||
37 | * | ||
38 | * [1] BANKF pins 14,15 do not form part of the external interrupt sources | ||
39 | * [2] BANK has two control registers, GPxCON0 and GPxCON1 | ||
40 | */ | ||
41 | |||
42 | static int s5p6440_gpiolib_rbank_4bit2_input(struct gpio_chip *chip, | ||
43 | unsigned int offset) | ||
44 | { | ||
45 | struct s3c_gpio_chip *ourchip = to_s3c_gpio(chip); | ||
46 | void __iomem *base = ourchip->base; | ||
47 | void __iomem *regcon = base; | ||
48 | unsigned long con; | ||
49 | |||
50 | switch (offset) { | ||
51 | case 6: | ||
52 | offset += 1; | ||
53 | case 0: | ||
54 | case 1: | ||
55 | case 2: | ||
56 | case 3: | ||
57 | case 4: | ||
58 | case 5: | ||
59 | regcon -= 4; | ||
60 | break; | ||
61 | default: | ||
62 | offset -= 7; | ||
63 | break; | ||
64 | } | ||
65 | |||
66 | con = __raw_readl(regcon); | ||
67 | con &= ~(0xf << con_4bit_shift(offset)); | ||
68 | __raw_writel(con, regcon); | ||
69 | |||
70 | return 0; | ||
71 | } | ||
72 | |||
73 | static int s5p6440_gpiolib_rbank_4bit2_output(struct gpio_chip *chip, | ||
74 | unsigned int offset, int value) | ||
75 | { | ||
76 | struct s3c_gpio_chip *ourchip = to_s3c_gpio(chip); | ||
77 | void __iomem *base = ourchip->base; | ||
78 | void __iomem *regcon = base; | ||
79 | unsigned long con; | ||
80 | unsigned long dat; | ||
81 | unsigned con_offset = offset; | ||
82 | |||
83 | switch (con_offset) { | ||
84 | case 6: | ||
85 | con_offset += 1; | ||
86 | case 0: | ||
87 | case 1: | ||
88 | case 2: | ||
89 | case 3: | ||
90 | case 4: | ||
91 | case 5: | ||
92 | regcon -= 4; | ||
93 | break; | ||
94 | default: | ||
95 | con_offset -= 7; | ||
96 | break; | ||
97 | } | ||
98 | |||
99 | con = __raw_readl(regcon); | ||
100 | con &= ~(0xf << con_4bit_shift(con_offset)); | ||
101 | con |= 0x1 << con_4bit_shift(con_offset); | ||
102 | |||
103 | dat = __raw_readl(base + GPIODAT_OFF); | ||
104 | if (value) | ||
105 | dat |= 1 << offset; | ||
106 | else | ||
107 | dat &= ~(1 << offset); | ||
108 | |||
109 | __raw_writel(con, regcon); | ||
110 | __raw_writel(dat, base + GPIODAT_OFF); | ||
111 | |||
112 | return 0; | ||
113 | } | ||
114 | |||
115 | int s5p6440_gpio_setcfg_4bit_rbank(struct s3c_gpio_chip *chip, | ||
116 | unsigned int off, unsigned int cfg) | ||
117 | { | ||
118 | void __iomem *reg = chip->base; | ||
119 | unsigned int shift; | ||
120 | u32 con; | ||
121 | |||
122 | switch (off) { | ||
123 | case 0: | ||
124 | case 1: | ||
125 | case 2: | ||
126 | case 3: | ||
127 | case 4: | ||
128 | case 5: | ||
129 | shift = (off & 7) * 4; | ||
130 | reg -= 4; | ||
131 | break; | ||
132 | case 6: | ||
133 | shift = ((off + 1) & 7) * 4; | ||
134 | reg -= 4; | ||
135 | default: | ||
136 | shift = ((off + 1) & 7) * 4; | ||
137 | break; | ||
138 | } | ||
139 | |||
140 | if (s3c_gpio_is_cfg_special(cfg)) { | ||
141 | cfg &= 0xf; | ||
142 | cfg <<= shift; | ||
143 | } | ||
144 | |||
145 | con = __raw_readl(reg); | ||
146 | con &= ~(0xf << shift); | ||
147 | con |= cfg; | ||
148 | __raw_writel(con, reg); | ||
149 | |||
150 | return 0; | ||
151 | } | ||
152 | |||
153 | static struct s3c_gpio_cfg s5p6440_gpio_cfgs[] = { | ||
154 | { | ||
155 | .cfg_eint = 0, | ||
156 | }, { | ||
157 | .cfg_eint = 7, | ||
158 | }, { | ||
159 | .cfg_eint = 3, | ||
160 | .set_config = s5p6440_gpio_setcfg_4bit_rbank, | ||
161 | }, { | ||
162 | .cfg_eint = 0, | ||
163 | .set_config = s3c_gpio_setcfg_s3c24xx, | ||
164 | }, { | ||
165 | .cfg_eint = 2, | ||
166 | .set_config = s3c_gpio_setcfg_s3c24xx, | ||
167 | }, { | ||
168 | .cfg_eint = 3, | ||
169 | .set_config = s3c_gpio_setcfg_s3c24xx, | ||
170 | }, | ||
171 | }; | ||
172 | |||
173 | static struct s3c_gpio_chip s5p6440_gpio_4bit[] = { | ||
174 | { | ||
175 | .base = S5P6440_GPA_BASE, | ||
176 | .config = &s5p6440_gpio_cfgs[1], | ||
177 | .chip = { | ||
178 | .base = S5P6440_GPA(0), | ||
179 | .ngpio = S5P6440_GPIO_A_NR, | ||
180 | .label = "GPA", | ||
181 | }, | ||
182 | }, { | ||
183 | .base = S5P6440_GPB_BASE, | ||
184 | .config = &s5p6440_gpio_cfgs[1], | ||
185 | .chip = { | ||
186 | .base = S5P6440_GPB(0), | ||
187 | .ngpio = S5P6440_GPIO_B_NR, | ||
188 | .label = "GPB", | ||
189 | }, | ||
190 | }, { | ||
191 | .base = S5P6440_GPC_BASE, | ||
192 | .config = &s5p6440_gpio_cfgs[1], | ||
193 | .chip = { | ||
194 | .base = S5P6440_GPC(0), | ||
195 | .ngpio = S5P6440_GPIO_C_NR, | ||
196 | .label = "GPC", | ||
197 | }, | ||
198 | }, { | ||
199 | .base = S5P6440_GPG_BASE, | ||
200 | .config = &s5p6440_gpio_cfgs[1], | ||
201 | .chip = { | ||
202 | .base = S5P6440_GPG(0), | ||
203 | .ngpio = S5P6440_GPIO_G_NR, | ||
204 | .label = "GPG", | ||
205 | }, | ||
206 | }, | ||
207 | }; | ||
208 | |||
209 | static struct s3c_gpio_chip s5p6440_gpio_4bit2[] = { | ||
210 | { | ||
211 | .base = S5P6440_GPH_BASE + 0x4, | ||
212 | .config = &s5p6440_gpio_cfgs[1], | ||
213 | .chip = { | ||
214 | .base = S5P6440_GPH(0), | ||
215 | .ngpio = S5P6440_GPIO_H_NR, | ||
216 | .label = "GPH", | ||
217 | }, | ||
218 | }, | ||
219 | }; | ||
220 | |||
221 | static struct s3c_gpio_chip gpio_rbank_4bit2[] = { | ||
222 | { | ||
223 | .base = S5P6440_GPR_BASE + 0x4, | ||
224 | .config = &s5p6440_gpio_cfgs[2], | ||
225 | .chip = { | ||
226 | .base = S5P6440_GPR(0), | ||
227 | .ngpio = S5P6440_GPIO_R_NR, | ||
228 | .label = "GPR", | ||
229 | }, | ||
230 | }, | ||
231 | }; | ||
232 | |||
233 | static struct s3c_gpio_chip s5p6440_gpio_2bit[] = { | ||
234 | { | ||
235 | .base = S5P6440_GPF_BASE, | ||
236 | .config = &s5p6440_gpio_cfgs[5], | ||
237 | .chip = { | ||
238 | .base = S5P6440_GPF(0), | ||
239 | .ngpio = S5P6440_GPIO_F_NR, | ||
240 | .label = "GPF", | ||
241 | }, | ||
242 | }, { | ||
243 | .base = S5P6440_GPI_BASE, | ||
244 | .config = &s5p6440_gpio_cfgs[3], | ||
245 | .chip = { | ||
246 | .base = S5P6440_GPI(0), | ||
247 | .ngpio = S5P6440_GPIO_I_NR, | ||
248 | .label = "GPI", | ||
249 | }, | ||
250 | }, { | ||
251 | .base = S5P6440_GPJ_BASE, | ||
252 | .config = &s5p6440_gpio_cfgs[3], | ||
253 | .chip = { | ||
254 | .base = S5P6440_GPJ(0), | ||
255 | .ngpio = S5P6440_GPIO_J_NR, | ||
256 | .label = "GPJ", | ||
257 | }, | ||
258 | }, { | ||
259 | .base = S5P6440_GPN_BASE, | ||
260 | .config = &s5p6440_gpio_cfgs[4], | ||
261 | .chip = { | ||
262 | .base = S5P6440_GPN(0), | ||
263 | .ngpio = S5P6440_GPIO_N_NR, | ||
264 | .label = "GPN", | ||
265 | }, | ||
266 | }, { | ||
267 | .base = S5P6440_GPP_BASE, | ||
268 | .config = &s5p6440_gpio_cfgs[5], | ||
269 | .chip = { | ||
270 | .base = S5P6440_GPP(0), | ||
271 | .ngpio = S5P6440_GPIO_P_NR, | ||
272 | .label = "GPP", | ||
273 | }, | ||
274 | }, | ||
275 | }; | ||
276 | |||
277 | void __init s5p6440_gpiolib_set_cfg(struct s3c_gpio_cfg *chipcfg, int nr_chips) | ||
278 | { | ||
279 | for (; nr_chips > 0; nr_chips--, chipcfg++) { | ||
280 | if (!chipcfg->set_config) | ||
281 | chipcfg->set_config = s3c_gpio_setcfg_s3c64xx_4bit; | ||
282 | if (!chipcfg->set_pull) | ||
283 | chipcfg->set_pull = s3c_gpio_setpull_updown; | ||
284 | if (!chipcfg->get_pull) | ||
285 | chipcfg->get_pull = s3c_gpio_getpull_updown; | ||
286 | } | ||
287 | } | ||
288 | |||
289 | static void __init s5p6440_gpio_add_rbank_4bit2(struct s3c_gpio_chip *chip, | ||
290 | int nr_chips) | ||
291 | { | ||
292 | for (; nr_chips > 0; nr_chips--, chip++) { | ||
293 | chip->chip.direction_input = s5p6440_gpiolib_rbank_4bit2_input; | ||
294 | chip->chip.direction_output = | ||
295 | s5p6440_gpiolib_rbank_4bit2_output; | ||
296 | s3c_gpiolib_add(chip); | ||
297 | } | ||
298 | } | ||
299 | |||
300 | static int __init s5p6440_gpiolib_init(void) | ||
301 | { | ||
302 | struct s3c_gpio_chip *chips = s5p6440_gpio_2bit; | ||
303 | int nr_chips = ARRAY_SIZE(s5p6440_gpio_2bit); | ||
304 | |||
305 | s5p6440_gpiolib_set_cfg(s5p6440_gpio_cfgs, | ||
306 | ARRAY_SIZE(s5p6440_gpio_cfgs)); | ||
307 | |||
308 | for (; nr_chips > 0; nr_chips--, chips++) | ||
309 | s3c_gpiolib_add(chips); | ||
310 | |||
311 | samsung_gpiolib_add_4bit_chips(s5p6440_gpio_4bit, | ||
312 | ARRAY_SIZE(s5p6440_gpio_4bit)); | ||
313 | |||
314 | samsung_gpiolib_add_4bit2_chips(s5p6440_gpio_4bit2, | ||
315 | ARRAY_SIZE(s5p6440_gpio_4bit2)); | ||
316 | |||
317 | s5p6440_gpio_add_rbank_4bit2(gpio_rbank_4bit2, | ||
318 | ARRAY_SIZE(gpio_rbank_4bit2)); | ||
319 | |||
320 | return 0; | ||
321 | } | ||
322 | arch_initcall(s5p6440_gpiolib_init); | ||