Loading...
1/*
2 * arch/arm/mach-lpc32xx/gpiolib.c
3 *
4 * Author: Kevin Wells <kevin.wells@nxp.com>
5 *
6 * Copyright (C) 2010 NXP Semiconductors
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 as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 */
18
19#include <linux/kernel.h>
20#include <linux/init.h>
21#include <linux/io.h>
22#include <linux/errno.h>
23#include <linux/gpio.h>
24#include <linux/of_gpio.h>
25#include <linux/platform_device.h>
26#include <linux/module.h>
27
28#include <mach/hardware.h>
29#include <mach/platform.h>
30#include <mach/gpio-lpc32xx.h>
31
32#define LPC32XX_GPIO_P3_INP_STATE _GPREG(0x000)
33#define LPC32XX_GPIO_P3_OUTP_SET _GPREG(0x004)
34#define LPC32XX_GPIO_P3_OUTP_CLR _GPREG(0x008)
35#define LPC32XX_GPIO_P3_OUTP_STATE _GPREG(0x00C)
36#define LPC32XX_GPIO_P2_DIR_SET _GPREG(0x010)
37#define LPC32XX_GPIO_P2_DIR_CLR _GPREG(0x014)
38#define LPC32XX_GPIO_P2_DIR_STATE _GPREG(0x018)
39#define LPC32XX_GPIO_P2_INP_STATE _GPREG(0x01C)
40#define LPC32XX_GPIO_P2_OUTP_SET _GPREG(0x020)
41#define LPC32XX_GPIO_P2_OUTP_CLR _GPREG(0x024)
42#define LPC32XX_GPIO_P2_MUX_SET _GPREG(0x028)
43#define LPC32XX_GPIO_P2_MUX_CLR _GPREG(0x02C)
44#define LPC32XX_GPIO_P2_MUX_STATE _GPREG(0x030)
45#define LPC32XX_GPIO_P0_INP_STATE _GPREG(0x040)
46#define LPC32XX_GPIO_P0_OUTP_SET _GPREG(0x044)
47#define LPC32XX_GPIO_P0_OUTP_CLR _GPREG(0x048)
48#define LPC32XX_GPIO_P0_OUTP_STATE _GPREG(0x04C)
49#define LPC32XX_GPIO_P0_DIR_SET _GPREG(0x050)
50#define LPC32XX_GPIO_P0_DIR_CLR _GPREG(0x054)
51#define LPC32XX_GPIO_P0_DIR_STATE _GPREG(0x058)
52#define LPC32XX_GPIO_P1_INP_STATE _GPREG(0x060)
53#define LPC32XX_GPIO_P1_OUTP_SET _GPREG(0x064)
54#define LPC32XX_GPIO_P1_OUTP_CLR _GPREG(0x068)
55#define LPC32XX_GPIO_P1_OUTP_STATE _GPREG(0x06C)
56#define LPC32XX_GPIO_P1_DIR_SET _GPREG(0x070)
57#define LPC32XX_GPIO_P1_DIR_CLR _GPREG(0x074)
58#define LPC32XX_GPIO_P1_DIR_STATE _GPREG(0x078)
59
60#define GPIO012_PIN_TO_BIT(x) (1 << (x))
61#define GPIO3_PIN_TO_BIT(x) (1 << ((x) + 25))
62#define GPO3_PIN_TO_BIT(x) (1 << (x))
63#define GPIO012_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
64#define GPIO3_PIN_IN_SHIFT(x) ((x) == 5 ? 24 : 10 + (x))
65#define GPIO3_PIN_IN_SEL(x, y) (((x) >> GPIO3_PIN_IN_SHIFT(y)) & 1)
66#define GPIO3_PIN5_IN_SEL(x) (((x) >> 24) & 1)
67#define GPI3_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
68#define GPO3_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
69
70struct gpio_regs {
71 void __iomem *inp_state;
72 void __iomem *outp_state;
73 void __iomem *outp_set;
74 void __iomem *outp_clr;
75 void __iomem *dir_set;
76 void __iomem *dir_clr;
77};
78
79/*
80 * GPIO names
81 */
82static const char *gpio_p0_names[LPC32XX_GPIO_P0_MAX] = {
83 "p0.0", "p0.1", "p0.2", "p0.3",
84 "p0.4", "p0.5", "p0.6", "p0.7"
85};
86
87static const char *gpio_p1_names[LPC32XX_GPIO_P1_MAX] = {
88 "p1.0", "p1.1", "p1.2", "p1.3",
89 "p1.4", "p1.5", "p1.6", "p1.7",
90 "p1.8", "p1.9", "p1.10", "p1.11",
91 "p1.12", "p1.13", "p1.14", "p1.15",
92 "p1.16", "p1.17", "p1.18", "p1.19",
93 "p1.20", "p1.21", "p1.22", "p1.23",
94};
95
96static const char *gpio_p2_names[LPC32XX_GPIO_P2_MAX] = {
97 "p2.0", "p2.1", "p2.2", "p2.3",
98 "p2.4", "p2.5", "p2.6", "p2.7",
99 "p2.8", "p2.9", "p2.10", "p2.11",
100 "p2.12"
101};
102
103static const char *gpio_p3_names[LPC32XX_GPIO_P3_MAX] = {
104 "gpio00", "gpio01", "gpio02", "gpio03",
105 "gpio04", "gpio05"
106};
107
108static const char *gpi_p3_names[LPC32XX_GPI_P3_MAX] = {
109 "gpi00", "gpi01", "gpi02", "gpi03",
110 "gpi04", "gpi05", "gpi06", "gpi07",
111 "gpi08", "gpi09", NULL, NULL,
112 NULL, NULL, NULL, "gpi15",
113 "gpi16", "gpi17", "gpi18", "gpi19",
114 "gpi20", "gpi21", "gpi22", "gpi23",
115 "gpi24", "gpi25", "gpi26", "gpi27"
116};
117
118static const char *gpo_p3_names[LPC32XX_GPO_P3_MAX] = {
119 "gpo00", "gpo01", "gpo02", "gpo03",
120 "gpo04", "gpo05", "gpo06", "gpo07",
121 "gpo08", "gpo09", "gpo10", "gpo11",
122 "gpo12", "gpo13", "gpo14", "gpo15",
123 "gpo16", "gpo17", "gpo18", "gpo19",
124 "gpo20", "gpo21", "gpo22", "gpo23"
125};
126
127static struct gpio_regs gpio_grp_regs_p0 = {
128 .inp_state = LPC32XX_GPIO_P0_INP_STATE,
129 .outp_set = LPC32XX_GPIO_P0_OUTP_SET,
130 .outp_clr = LPC32XX_GPIO_P0_OUTP_CLR,
131 .dir_set = LPC32XX_GPIO_P0_DIR_SET,
132 .dir_clr = LPC32XX_GPIO_P0_DIR_CLR,
133};
134
135static struct gpio_regs gpio_grp_regs_p1 = {
136 .inp_state = LPC32XX_GPIO_P1_INP_STATE,
137 .outp_set = LPC32XX_GPIO_P1_OUTP_SET,
138 .outp_clr = LPC32XX_GPIO_P1_OUTP_CLR,
139 .dir_set = LPC32XX_GPIO_P1_DIR_SET,
140 .dir_clr = LPC32XX_GPIO_P1_DIR_CLR,
141};
142
143static struct gpio_regs gpio_grp_regs_p2 = {
144 .inp_state = LPC32XX_GPIO_P2_INP_STATE,
145 .outp_set = LPC32XX_GPIO_P2_OUTP_SET,
146 .outp_clr = LPC32XX_GPIO_P2_OUTP_CLR,
147 .dir_set = LPC32XX_GPIO_P2_DIR_SET,
148 .dir_clr = LPC32XX_GPIO_P2_DIR_CLR,
149};
150
151static struct gpio_regs gpio_grp_regs_p3 = {
152 .inp_state = LPC32XX_GPIO_P3_INP_STATE,
153 .outp_state = LPC32XX_GPIO_P3_OUTP_STATE,
154 .outp_set = LPC32XX_GPIO_P3_OUTP_SET,
155 .outp_clr = LPC32XX_GPIO_P3_OUTP_CLR,
156 .dir_set = LPC32XX_GPIO_P2_DIR_SET,
157 .dir_clr = LPC32XX_GPIO_P2_DIR_CLR,
158};
159
160struct lpc32xx_gpio_chip {
161 struct gpio_chip chip;
162 struct gpio_regs *gpio_grp;
163};
164
165static inline struct lpc32xx_gpio_chip *to_lpc32xx_gpio(
166 struct gpio_chip *gpc)
167{
168 return container_of(gpc, struct lpc32xx_gpio_chip, chip);
169}
170
171static void __set_gpio_dir_p012(struct lpc32xx_gpio_chip *group,
172 unsigned pin, int input)
173{
174 if (input)
175 __raw_writel(GPIO012_PIN_TO_BIT(pin),
176 group->gpio_grp->dir_clr);
177 else
178 __raw_writel(GPIO012_PIN_TO_BIT(pin),
179 group->gpio_grp->dir_set);
180}
181
182static void __set_gpio_dir_p3(struct lpc32xx_gpio_chip *group,
183 unsigned pin, int input)
184{
185 u32 u = GPIO3_PIN_TO_BIT(pin);
186
187 if (input)
188 __raw_writel(u, group->gpio_grp->dir_clr);
189 else
190 __raw_writel(u, group->gpio_grp->dir_set);
191}
192
193static void __set_gpio_level_p012(struct lpc32xx_gpio_chip *group,
194 unsigned pin, int high)
195{
196 if (high)
197 __raw_writel(GPIO012_PIN_TO_BIT(pin),
198 group->gpio_grp->outp_set);
199 else
200 __raw_writel(GPIO012_PIN_TO_BIT(pin),
201 group->gpio_grp->outp_clr);
202}
203
204static void __set_gpio_level_p3(struct lpc32xx_gpio_chip *group,
205 unsigned pin, int high)
206{
207 u32 u = GPIO3_PIN_TO_BIT(pin);
208
209 if (high)
210 __raw_writel(u, group->gpio_grp->outp_set);
211 else
212 __raw_writel(u, group->gpio_grp->outp_clr);
213}
214
215static void __set_gpo_level_p3(struct lpc32xx_gpio_chip *group,
216 unsigned pin, int high)
217{
218 if (high)
219 __raw_writel(GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_set);
220 else
221 __raw_writel(GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_clr);
222}
223
224static int __get_gpio_state_p012(struct lpc32xx_gpio_chip *group,
225 unsigned pin)
226{
227 return GPIO012_PIN_IN_SEL(__raw_readl(group->gpio_grp->inp_state),
228 pin);
229}
230
231static int __get_gpio_state_p3(struct lpc32xx_gpio_chip *group,
232 unsigned pin)
233{
234 int state = __raw_readl(group->gpio_grp->inp_state);
235
236 /*
237 * P3 GPIO pin input mapping is not contiguous, GPIOP3-0..4 is mapped
238 * to bits 10..14, while GPIOP3-5 is mapped to bit 24.
239 */
240 return GPIO3_PIN_IN_SEL(state, pin);
241}
242
243static int __get_gpi_state_p3(struct lpc32xx_gpio_chip *group,
244 unsigned pin)
245{
246 return GPI3_PIN_IN_SEL(__raw_readl(group->gpio_grp->inp_state), pin);
247}
248
249static int __get_gpo_state_p3(struct lpc32xx_gpio_chip *group,
250 unsigned pin)
251{
252 return GPO3_PIN_IN_SEL(__raw_readl(group->gpio_grp->outp_state), pin);
253}
254
255/*
256 * GENERIC_GPIO primitives.
257 */
258static int lpc32xx_gpio_dir_input_p012(struct gpio_chip *chip,
259 unsigned pin)
260{
261 struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
262
263 __set_gpio_dir_p012(group, pin, 1);
264
265 return 0;
266}
267
268static int lpc32xx_gpio_dir_input_p3(struct gpio_chip *chip,
269 unsigned pin)
270{
271 struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
272
273 __set_gpio_dir_p3(group, pin, 1);
274
275 return 0;
276}
277
278static int lpc32xx_gpio_dir_in_always(struct gpio_chip *chip,
279 unsigned pin)
280{
281 return 0;
282}
283
284static int lpc32xx_gpio_get_value_p012(struct gpio_chip *chip, unsigned pin)
285{
286 struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
287
288 return __get_gpio_state_p012(group, pin);
289}
290
291static int lpc32xx_gpio_get_value_p3(struct gpio_chip *chip, unsigned pin)
292{
293 struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
294
295 return __get_gpio_state_p3(group, pin);
296}
297
298static int lpc32xx_gpi_get_value(struct gpio_chip *chip, unsigned pin)
299{
300 struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
301
302 return __get_gpi_state_p3(group, pin);
303}
304
305static int lpc32xx_gpio_dir_output_p012(struct gpio_chip *chip, unsigned pin,
306 int value)
307{
308 struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
309
310 __set_gpio_level_p012(group, pin, value);
311 __set_gpio_dir_p012(group, pin, 0);
312
313 return 0;
314}
315
316static int lpc32xx_gpio_dir_output_p3(struct gpio_chip *chip, unsigned pin,
317 int value)
318{
319 struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
320
321 __set_gpio_level_p3(group, pin, value);
322 __set_gpio_dir_p3(group, pin, 0);
323
324 return 0;
325}
326
327static int lpc32xx_gpio_dir_out_always(struct gpio_chip *chip, unsigned pin,
328 int value)
329{
330 struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
331
332 __set_gpo_level_p3(group, pin, value);
333 return 0;
334}
335
336static void lpc32xx_gpio_set_value_p012(struct gpio_chip *chip, unsigned pin,
337 int value)
338{
339 struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
340
341 __set_gpio_level_p012(group, pin, value);
342}
343
344static void lpc32xx_gpio_set_value_p3(struct gpio_chip *chip, unsigned pin,
345 int value)
346{
347 struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
348
349 __set_gpio_level_p3(group, pin, value);
350}
351
352static void lpc32xx_gpo_set_value(struct gpio_chip *chip, unsigned pin,
353 int value)
354{
355 struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
356
357 __set_gpo_level_p3(group, pin, value);
358}
359
360static int lpc32xx_gpo_get_value(struct gpio_chip *chip, unsigned pin)
361{
362 struct lpc32xx_gpio_chip *group = to_lpc32xx_gpio(chip);
363
364 return __get_gpo_state_p3(group, pin);
365}
366
367static int lpc32xx_gpio_request(struct gpio_chip *chip, unsigned pin)
368{
369 if (pin < chip->ngpio)
370 return 0;
371
372 return -EINVAL;
373}
374
375static struct lpc32xx_gpio_chip lpc32xx_gpiochip[] = {
376 {
377 .chip = {
378 .label = "gpio_p0",
379 .direction_input = lpc32xx_gpio_dir_input_p012,
380 .get = lpc32xx_gpio_get_value_p012,
381 .direction_output = lpc32xx_gpio_dir_output_p012,
382 .set = lpc32xx_gpio_set_value_p012,
383 .request = lpc32xx_gpio_request,
384 .base = LPC32XX_GPIO_P0_GRP,
385 .ngpio = LPC32XX_GPIO_P0_MAX,
386 .names = gpio_p0_names,
387 .can_sleep = 0,
388 },
389 .gpio_grp = &gpio_grp_regs_p0,
390 },
391 {
392 .chip = {
393 .label = "gpio_p1",
394 .direction_input = lpc32xx_gpio_dir_input_p012,
395 .get = lpc32xx_gpio_get_value_p012,
396 .direction_output = lpc32xx_gpio_dir_output_p012,
397 .set = lpc32xx_gpio_set_value_p012,
398 .request = lpc32xx_gpio_request,
399 .base = LPC32XX_GPIO_P1_GRP,
400 .ngpio = LPC32XX_GPIO_P1_MAX,
401 .names = gpio_p1_names,
402 .can_sleep = 0,
403 },
404 .gpio_grp = &gpio_grp_regs_p1,
405 },
406 {
407 .chip = {
408 .label = "gpio_p2",
409 .direction_input = lpc32xx_gpio_dir_input_p012,
410 .get = lpc32xx_gpio_get_value_p012,
411 .direction_output = lpc32xx_gpio_dir_output_p012,
412 .set = lpc32xx_gpio_set_value_p012,
413 .request = lpc32xx_gpio_request,
414 .base = LPC32XX_GPIO_P2_GRP,
415 .ngpio = LPC32XX_GPIO_P2_MAX,
416 .names = gpio_p2_names,
417 .can_sleep = 0,
418 },
419 .gpio_grp = &gpio_grp_regs_p2,
420 },
421 {
422 .chip = {
423 .label = "gpio_p3",
424 .direction_input = lpc32xx_gpio_dir_input_p3,
425 .get = lpc32xx_gpio_get_value_p3,
426 .direction_output = lpc32xx_gpio_dir_output_p3,
427 .set = lpc32xx_gpio_set_value_p3,
428 .request = lpc32xx_gpio_request,
429 .base = LPC32XX_GPIO_P3_GRP,
430 .ngpio = LPC32XX_GPIO_P3_MAX,
431 .names = gpio_p3_names,
432 .can_sleep = 0,
433 },
434 .gpio_grp = &gpio_grp_regs_p3,
435 },
436 {
437 .chip = {
438 .label = "gpi_p3",
439 .direction_input = lpc32xx_gpio_dir_in_always,
440 .get = lpc32xx_gpi_get_value,
441 .request = lpc32xx_gpio_request,
442 .base = LPC32XX_GPI_P3_GRP,
443 .ngpio = LPC32XX_GPI_P3_MAX,
444 .names = gpi_p3_names,
445 .can_sleep = 0,
446 },
447 .gpio_grp = &gpio_grp_regs_p3,
448 },
449 {
450 .chip = {
451 .label = "gpo_p3",
452 .direction_output = lpc32xx_gpio_dir_out_always,
453 .set = lpc32xx_gpo_set_value,
454 .get = lpc32xx_gpo_get_value,
455 .request = lpc32xx_gpio_request,
456 .base = LPC32XX_GPO_P3_GRP,
457 .ngpio = LPC32XX_GPO_P3_MAX,
458 .names = gpo_p3_names,
459 .can_sleep = 0,
460 },
461 .gpio_grp = &gpio_grp_regs_p3,
462 },
463};
464
465/* Empty now, can be removed later when mach-lpc32xx is finally switched over
466 * to DT support
467 */
468void __init lpc32xx_gpio_init(void)
469{
470}
471
472static int lpc32xx_of_xlate(struct gpio_chip *gc,
473 const struct of_phandle_args *gpiospec, u32 *flags)
474{
475 /* Is this the correct bank? */
476 u32 bank = gpiospec->args[0];
477 if ((bank > ARRAY_SIZE(lpc32xx_gpiochip) ||
478 (gc != &lpc32xx_gpiochip[bank].chip)))
479 return -EINVAL;
480
481 if (flags)
482 *flags = gpiospec->args[2];
483 return gpiospec->args[1];
484}
485
486static int __devinit lpc32xx_gpio_probe(struct platform_device *pdev)
487{
488 int i;
489
490 for (i = 0; i < ARRAY_SIZE(lpc32xx_gpiochip); i++) {
491 if (pdev->dev.of_node) {
492 lpc32xx_gpiochip[i].chip.of_xlate = lpc32xx_of_xlate;
493 lpc32xx_gpiochip[i].chip.of_gpio_n_cells = 3;
494 lpc32xx_gpiochip[i].chip.of_node = pdev->dev.of_node;
495 }
496 gpiochip_add(&lpc32xx_gpiochip[i].chip);
497 }
498
499 return 0;
500}
501
502#ifdef CONFIG_OF
503static struct of_device_id lpc32xx_gpio_of_match[] __devinitdata = {
504 { .compatible = "nxp,lpc3220-gpio", },
505 { },
506};
507#endif
508
509static struct platform_driver lpc32xx_gpio_driver = {
510 .driver = {
511 .name = "lpc32xx-gpio",
512 .owner = THIS_MODULE,
513 .of_match_table = of_match_ptr(lpc32xx_gpio_of_match),
514 },
515 .probe = lpc32xx_gpio_probe,
516};
517
518module_platform_driver(lpc32xx_gpio_driver);
1/*
2 * GPIO driver for LPC32xx SoC
3 *
4 * Author: Kevin Wells <kevin.wells@nxp.com>
5 *
6 * Copyright (C) 2010 NXP Semiconductors
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 as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 */
18
19#include <linux/kernel.h>
20#include <linux/init.h>
21#include <linux/io.h>
22#include <linux/errno.h>
23#include <linux/gpio.h>
24#include <linux/of.h>
25#include <linux/of_gpio.h>
26#include <linux/platform_device.h>
27#include <linux/module.h>
28
29#include <mach/hardware.h>
30#include <mach/platform.h>
31
32#define LPC32XX_GPIO_P3_INP_STATE _GPREG(0x000)
33#define LPC32XX_GPIO_P3_OUTP_SET _GPREG(0x004)
34#define LPC32XX_GPIO_P3_OUTP_CLR _GPREG(0x008)
35#define LPC32XX_GPIO_P3_OUTP_STATE _GPREG(0x00C)
36#define LPC32XX_GPIO_P2_DIR_SET _GPREG(0x010)
37#define LPC32XX_GPIO_P2_DIR_CLR _GPREG(0x014)
38#define LPC32XX_GPIO_P2_DIR_STATE _GPREG(0x018)
39#define LPC32XX_GPIO_P2_INP_STATE _GPREG(0x01C)
40#define LPC32XX_GPIO_P2_OUTP_SET _GPREG(0x020)
41#define LPC32XX_GPIO_P2_OUTP_CLR _GPREG(0x024)
42#define LPC32XX_GPIO_P2_MUX_SET _GPREG(0x028)
43#define LPC32XX_GPIO_P2_MUX_CLR _GPREG(0x02C)
44#define LPC32XX_GPIO_P2_MUX_STATE _GPREG(0x030)
45#define LPC32XX_GPIO_P0_INP_STATE _GPREG(0x040)
46#define LPC32XX_GPIO_P0_OUTP_SET _GPREG(0x044)
47#define LPC32XX_GPIO_P0_OUTP_CLR _GPREG(0x048)
48#define LPC32XX_GPIO_P0_OUTP_STATE _GPREG(0x04C)
49#define LPC32XX_GPIO_P0_DIR_SET _GPREG(0x050)
50#define LPC32XX_GPIO_P0_DIR_CLR _GPREG(0x054)
51#define LPC32XX_GPIO_P0_DIR_STATE _GPREG(0x058)
52#define LPC32XX_GPIO_P1_INP_STATE _GPREG(0x060)
53#define LPC32XX_GPIO_P1_OUTP_SET _GPREG(0x064)
54#define LPC32XX_GPIO_P1_OUTP_CLR _GPREG(0x068)
55#define LPC32XX_GPIO_P1_OUTP_STATE _GPREG(0x06C)
56#define LPC32XX_GPIO_P1_DIR_SET _GPREG(0x070)
57#define LPC32XX_GPIO_P1_DIR_CLR _GPREG(0x074)
58#define LPC32XX_GPIO_P1_DIR_STATE _GPREG(0x078)
59
60#define GPIO012_PIN_TO_BIT(x) (1 << (x))
61#define GPIO3_PIN_TO_BIT(x) (1 << ((x) + 25))
62#define GPO3_PIN_TO_BIT(x) (1 << (x))
63#define GPIO012_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
64#define GPIO3_PIN_IN_SHIFT(x) ((x) == 5 ? 24 : 10 + (x))
65#define GPIO3_PIN_IN_SEL(x, y) (((x) >> GPIO3_PIN_IN_SHIFT(y)) & 1)
66#define GPIO3_PIN5_IN_SEL(x) (((x) >> 24) & 1)
67#define GPI3_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
68#define GPO3_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
69
70#define LPC32XX_GPIO_P0_MAX 8
71#define LPC32XX_GPIO_P1_MAX 24
72#define LPC32XX_GPIO_P2_MAX 13
73#define LPC32XX_GPIO_P3_MAX 6
74#define LPC32XX_GPI_P3_MAX 29
75#define LPC32XX_GPO_P3_MAX 24
76
77#define LPC32XX_GPIO_P0_GRP 0
78#define LPC32XX_GPIO_P1_GRP (LPC32XX_GPIO_P0_GRP + LPC32XX_GPIO_P0_MAX)
79#define LPC32XX_GPIO_P2_GRP (LPC32XX_GPIO_P1_GRP + LPC32XX_GPIO_P1_MAX)
80#define LPC32XX_GPIO_P3_GRP (LPC32XX_GPIO_P2_GRP + LPC32XX_GPIO_P2_MAX)
81#define LPC32XX_GPI_P3_GRP (LPC32XX_GPIO_P3_GRP + LPC32XX_GPIO_P3_MAX)
82#define LPC32XX_GPO_P3_GRP (LPC32XX_GPI_P3_GRP + LPC32XX_GPI_P3_MAX)
83
84struct gpio_regs {
85 void __iomem *inp_state;
86 void __iomem *outp_state;
87 void __iomem *outp_set;
88 void __iomem *outp_clr;
89 void __iomem *dir_set;
90 void __iomem *dir_clr;
91};
92
93/*
94 * GPIO names
95 */
96static const char *gpio_p0_names[LPC32XX_GPIO_P0_MAX] = {
97 "p0.0", "p0.1", "p0.2", "p0.3",
98 "p0.4", "p0.5", "p0.6", "p0.7"
99};
100
101static const char *gpio_p1_names[LPC32XX_GPIO_P1_MAX] = {
102 "p1.0", "p1.1", "p1.2", "p1.3",
103 "p1.4", "p1.5", "p1.6", "p1.7",
104 "p1.8", "p1.9", "p1.10", "p1.11",
105 "p1.12", "p1.13", "p1.14", "p1.15",
106 "p1.16", "p1.17", "p1.18", "p1.19",
107 "p1.20", "p1.21", "p1.22", "p1.23",
108};
109
110static const char *gpio_p2_names[LPC32XX_GPIO_P2_MAX] = {
111 "p2.0", "p2.1", "p2.2", "p2.3",
112 "p2.4", "p2.5", "p2.6", "p2.7",
113 "p2.8", "p2.9", "p2.10", "p2.11",
114 "p2.12"
115};
116
117static const char *gpio_p3_names[LPC32XX_GPIO_P3_MAX] = {
118 "gpio00", "gpio01", "gpio02", "gpio03",
119 "gpio04", "gpio05"
120};
121
122static const char *gpi_p3_names[LPC32XX_GPI_P3_MAX] = {
123 "gpi00", "gpi01", "gpi02", "gpi03",
124 "gpi04", "gpi05", "gpi06", "gpi07",
125 "gpi08", "gpi09", NULL, NULL,
126 NULL, NULL, NULL, "gpi15",
127 "gpi16", "gpi17", "gpi18", "gpi19",
128 "gpi20", "gpi21", "gpi22", "gpi23",
129 "gpi24", "gpi25", "gpi26", "gpi27",
130 "gpi28"
131};
132
133static const char *gpo_p3_names[LPC32XX_GPO_P3_MAX] = {
134 "gpo00", "gpo01", "gpo02", "gpo03",
135 "gpo04", "gpo05", "gpo06", "gpo07",
136 "gpo08", "gpo09", "gpo10", "gpo11",
137 "gpo12", "gpo13", "gpo14", "gpo15",
138 "gpo16", "gpo17", "gpo18", "gpo19",
139 "gpo20", "gpo21", "gpo22", "gpo23"
140};
141
142static struct gpio_regs gpio_grp_regs_p0 = {
143 .inp_state = LPC32XX_GPIO_P0_INP_STATE,
144 .outp_set = LPC32XX_GPIO_P0_OUTP_SET,
145 .outp_clr = LPC32XX_GPIO_P0_OUTP_CLR,
146 .dir_set = LPC32XX_GPIO_P0_DIR_SET,
147 .dir_clr = LPC32XX_GPIO_P0_DIR_CLR,
148};
149
150static struct gpio_regs gpio_grp_regs_p1 = {
151 .inp_state = LPC32XX_GPIO_P1_INP_STATE,
152 .outp_set = LPC32XX_GPIO_P1_OUTP_SET,
153 .outp_clr = LPC32XX_GPIO_P1_OUTP_CLR,
154 .dir_set = LPC32XX_GPIO_P1_DIR_SET,
155 .dir_clr = LPC32XX_GPIO_P1_DIR_CLR,
156};
157
158static struct gpio_regs gpio_grp_regs_p2 = {
159 .inp_state = LPC32XX_GPIO_P2_INP_STATE,
160 .outp_set = LPC32XX_GPIO_P2_OUTP_SET,
161 .outp_clr = LPC32XX_GPIO_P2_OUTP_CLR,
162 .dir_set = LPC32XX_GPIO_P2_DIR_SET,
163 .dir_clr = LPC32XX_GPIO_P2_DIR_CLR,
164};
165
166static struct gpio_regs gpio_grp_regs_p3 = {
167 .inp_state = LPC32XX_GPIO_P3_INP_STATE,
168 .outp_state = LPC32XX_GPIO_P3_OUTP_STATE,
169 .outp_set = LPC32XX_GPIO_P3_OUTP_SET,
170 .outp_clr = LPC32XX_GPIO_P3_OUTP_CLR,
171 .dir_set = LPC32XX_GPIO_P2_DIR_SET,
172 .dir_clr = LPC32XX_GPIO_P2_DIR_CLR,
173};
174
175struct lpc32xx_gpio_chip {
176 struct gpio_chip chip;
177 struct gpio_regs *gpio_grp;
178};
179
180static void __set_gpio_dir_p012(struct lpc32xx_gpio_chip *group,
181 unsigned pin, int input)
182{
183 if (input)
184 __raw_writel(GPIO012_PIN_TO_BIT(pin),
185 group->gpio_grp->dir_clr);
186 else
187 __raw_writel(GPIO012_PIN_TO_BIT(pin),
188 group->gpio_grp->dir_set);
189}
190
191static void __set_gpio_dir_p3(struct lpc32xx_gpio_chip *group,
192 unsigned pin, int input)
193{
194 u32 u = GPIO3_PIN_TO_BIT(pin);
195
196 if (input)
197 __raw_writel(u, group->gpio_grp->dir_clr);
198 else
199 __raw_writel(u, group->gpio_grp->dir_set);
200}
201
202static void __set_gpio_level_p012(struct lpc32xx_gpio_chip *group,
203 unsigned pin, int high)
204{
205 if (high)
206 __raw_writel(GPIO012_PIN_TO_BIT(pin),
207 group->gpio_grp->outp_set);
208 else
209 __raw_writel(GPIO012_PIN_TO_BIT(pin),
210 group->gpio_grp->outp_clr);
211}
212
213static void __set_gpio_level_p3(struct lpc32xx_gpio_chip *group,
214 unsigned pin, int high)
215{
216 u32 u = GPIO3_PIN_TO_BIT(pin);
217
218 if (high)
219 __raw_writel(u, group->gpio_grp->outp_set);
220 else
221 __raw_writel(u, group->gpio_grp->outp_clr);
222}
223
224static void __set_gpo_level_p3(struct lpc32xx_gpio_chip *group,
225 unsigned pin, int high)
226{
227 if (high)
228 __raw_writel(GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_set);
229 else
230 __raw_writel(GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_clr);
231}
232
233static int __get_gpio_state_p012(struct lpc32xx_gpio_chip *group,
234 unsigned pin)
235{
236 return GPIO012_PIN_IN_SEL(__raw_readl(group->gpio_grp->inp_state),
237 pin);
238}
239
240static int __get_gpio_state_p3(struct lpc32xx_gpio_chip *group,
241 unsigned pin)
242{
243 int state = __raw_readl(group->gpio_grp->inp_state);
244
245 /*
246 * P3 GPIO pin input mapping is not contiguous, GPIOP3-0..4 is mapped
247 * to bits 10..14, while GPIOP3-5 is mapped to bit 24.
248 */
249 return GPIO3_PIN_IN_SEL(state, pin);
250}
251
252static int __get_gpi_state_p3(struct lpc32xx_gpio_chip *group,
253 unsigned pin)
254{
255 return GPI3_PIN_IN_SEL(__raw_readl(group->gpio_grp->inp_state), pin);
256}
257
258static int __get_gpo_state_p3(struct lpc32xx_gpio_chip *group,
259 unsigned pin)
260{
261 return GPO3_PIN_IN_SEL(__raw_readl(group->gpio_grp->outp_state), pin);
262}
263
264/*
265 * GPIO primitives.
266 */
267static int lpc32xx_gpio_dir_input_p012(struct gpio_chip *chip,
268 unsigned pin)
269{
270 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
271
272 __set_gpio_dir_p012(group, pin, 1);
273
274 return 0;
275}
276
277static int lpc32xx_gpio_dir_input_p3(struct gpio_chip *chip,
278 unsigned pin)
279{
280 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
281
282 __set_gpio_dir_p3(group, pin, 1);
283
284 return 0;
285}
286
287static int lpc32xx_gpio_dir_in_always(struct gpio_chip *chip,
288 unsigned pin)
289{
290 return 0;
291}
292
293static int lpc32xx_gpio_get_value_p012(struct gpio_chip *chip, unsigned pin)
294{
295 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
296
297 return !!__get_gpio_state_p012(group, pin);
298}
299
300static int lpc32xx_gpio_get_value_p3(struct gpio_chip *chip, unsigned pin)
301{
302 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
303
304 return !!__get_gpio_state_p3(group, pin);
305}
306
307static int lpc32xx_gpi_get_value(struct gpio_chip *chip, unsigned pin)
308{
309 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
310
311 return !!__get_gpi_state_p3(group, pin);
312}
313
314static int lpc32xx_gpio_dir_output_p012(struct gpio_chip *chip, unsigned pin,
315 int value)
316{
317 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
318
319 __set_gpio_level_p012(group, pin, value);
320 __set_gpio_dir_p012(group, pin, 0);
321
322 return 0;
323}
324
325static int lpc32xx_gpio_dir_output_p3(struct gpio_chip *chip, unsigned pin,
326 int value)
327{
328 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
329
330 __set_gpio_level_p3(group, pin, value);
331 __set_gpio_dir_p3(group, pin, 0);
332
333 return 0;
334}
335
336static int lpc32xx_gpio_dir_out_always(struct gpio_chip *chip, unsigned pin,
337 int value)
338{
339 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
340
341 __set_gpo_level_p3(group, pin, value);
342 return 0;
343}
344
345static void lpc32xx_gpio_set_value_p012(struct gpio_chip *chip, unsigned pin,
346 int value)
347{
348 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
349
350 __set_gpio_level_p012(group, pin, value);
351}
352
353static void lpc32xx_gpio_set_value_p3(struct gpio_chip *chip, unsigned pin,
354 int value)
355{
356 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
357
358 __set_gpio_level_p3(group, pin, value);
359}
360
361static void lpc32xx_gpo_set_value(struct gpio_chip *chip, unsigned pin,
362 int value)
363{
364 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
365
366 __set_gpo_level_p3(group, pin, value);
367}
368
369static int lpc32xx_gpo_get_value(struct gpio_chip *chip, unsigned pin)
370{
371 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
372
373 return !!__get_gpo_state_p3(group, pin);
374}
375
376static int lpc32xx_gpio_request(struct gpio_chip *chip, unsigned pin)
377{
378 if (pin < chip->ngpio)
379 return 0;
380
381 return -EINVAL;
382}
383
384static int lpc32xx_gpio_to_irq_p01(struct gpio_chip *chip, unsigned offset)
385{
386 return -ENXIO;
387}
388
389static int lpc32xx_gpio_to_irq_gpio_p3(struct gpio_chip *chip, unsigned offset)
390{
391 return -ENXIO;
392}
393
394static int lpc32xx_gpio_to_irq_gpi_p3(struct gpio_chip *chip, unsigned offset)
395{
396 return -ENXIO;
397}
398
399static struct lpc32xx_gpio_chip lpc32xx_gpiochip[] = {
400 {
401 .chip = {
402 .label = "gpio_p0",
403 .direction_input = lpc32xx_gpio_dir_input_p012,
404 .get = lpc32xx_gpio_get_value_p012,
405 .direction_output = lpc32xx_gpio_dir_output_p012,
406 .set = lpc32xx_gpio_set_value_p012,
407 .request = lpc32xx_gpio_request,
408 .to_irq = lpc32xx_gpio_to_irq_p01,
409 .base = LPC32XX_GPIO_P0_GRP,
410 .ngpio = LPC32XX_GPIO_P0_MAX,
411 .names = gpio_p0_names,
412 .can_sleep = false,
413 },
414 .gpio_grp = &gpio_grp_regs_p0,
415 },
416 {
417 .chip = {
418 .label = "gpio_p1",
419 .direction_input = lpc32xx_gpio_dir_input_p012,
420 .get = lpc32xx_gpio_get_value_p012,
421 .direction_output = lpc32xx_gpio_dir_output_p012,
422 .set = lpc32xx_gpio_set_value_p012,
423 .request = lpc32xx_gpio_request,
424 .to_irq = lpc32xx_gpio_to_irq_p01,
425 .base = LPC32XX_GPIO_P1_GRP,
426 .ngpio = LPC32XX_GPIO_P1_MAX,
427 .names = gpio_p1_names,
428 .can_sleep = false,
429 },
430 .gpio_grp = &gpio_grp_regs_p1,
431 },
432 {
433 .chip = {
434 .label = "gpio_p2",
435 .direction_input = lpc32xx_gpio_dir_input_p012,
436 .get = lpc32xx_gpio_get_value_p012,
437 .direction_output = lpc32xx_gpio_dir_output_p012,
438 .set = lpc32xx_gpio_set_value_p012,
439 .request = lpc32xx_gpio_request,
440 .base = LPC32XX_GPIO_P2_GRP,
441 .ngpio = LPC32XX_GPIO_P2_MAX,
442 .names = gpio_p2_names,
443 .can_sleep = false,
444 },
445 .gpio_grp = &gpio_grp_regs_p2,
446 },
447 {
448 .chip = {
449 .label = "gpio_p3",
450 .direction_input = lpc32xx_gpio_dir_input_p3,
451 .get = lpc32xx_gpio_get_value_p3,
452 .direction_output = lpc32xx_gpio_dir_output_p3,
453 .set = lpc32xx_gpio_set_value_p3,
454 .request = lpc32xx_gpio_request,
455 .to_irq = lpc32xx_gpio_to_irq_gpio_p3,
456 .base = LPC32XX_GPIO_P3_GRP,
457 .ngpio = LPC32XX_GPIO_P3_MAX,
458 .names = gpio_p3_names,
459 .can_sleep = false,
460 },
461 .gpio_grp = &gpio_grp_regs_p3,
462 },
463 {
464 .chip = {
465 .label = "gpi_p3",
466 .direction_input = lpc32xx_gpio_dir_in_always,
467 .get = lpc32xx_gpi_get_value,
468 .request = lpc32xx_gpio_request,
469 .to_irq = lpc32xx_gpio_to_irq_gpi_p3,
470 .base = LPC32XX_GPI_P3_GRP,
471 .ngpio = LPC32XX_GPI_P3_MAX,
472 .names = gpi_p3_names,
473 .can_sleep = false,
474 },
475 .gpio_grp = &gpio_grp_regs_p3,
476 },
477 {
478 .chip = {
479 .label = "gpo_p3",
480 .direction_output = lpc32xx_gpio_dir_out_always,
481 .set = lpc32xx_gpo_set_value,
482 .get = lpc32xx_gpo_get_value,
483 .request = lpc32xx_gpio_request,
484 .base = LPC32XX_GPO_P3_GRP,
485 .ngpio = LPC32XX_GPO_P3_MAX,
486 .names = gpo_p3_names,
487 .can_sleep = false,
488 },
489 .gpio_grp = &gpio_grp_regs_p3,
490 },
491};
492
493static int lpc32xx_of_xlate(struct gpio_chip *gc,
494 const struct of_phandle_args *gpiospec, u32 *flags)
495{
496 /* Is this the correct bank? */
497 u32 bank = gpiospec->args[0];
498 if ((bank >= ARRAY_SIZE(lpc32xx_gpiochip) ||
499 (gc != &lpc32xx_gpiochip[bank].chip)))
500 return -EINVAL;
501
502 if (flags)
503 *flags = gpiospec->args[2];
504 return gpiospec->args[1];
505}
506
507static int lpc32xx_gpio_probe(struct platform_device *pdev)
508{
509 int i;
510
511 for (i = 0; i < ARRAY_SIZE(lpc32xx_gpiochip); i++) {
512 if (pdev->dev.of_node) {
513 lpc32xx_gpiochip[i].chip.of_xlate = lpc32xx_of_xlate;
514 lpc32xx_gpiochip[i].chip.of_gpio_n_cells = 3;
515 lpc32xx_gpiochip[i].chip.of_node = pdev->dev.of_node;
516 }
517 devm_gpiochip_add_data(&pdev->dev, &lpc32xx_gpiochip[i].chip,
518 &lpc32xx_gpiochip[i]);
519 }
520
521 return 0;
522}
523
524#ifdef CONFIG_OF
525static const struct of_device_id lpc32xx_gpio_of_match[] = {
526 { .compatible = "nxp,lpc3220-gpio", },
527 { },
528};
529#endif
530
531static struct platform_driver lpc32xx_gpio_driver = {
532 .driver = {
533 .name = "lpc32xx-gpio",
534 .of_match_table = of_match_ptr(lpc32xx_gpio_of_match),
535 },
536 .probe = lpc32xx_gpio_probe,
537};
538
539module_platform_driver(lpc32xx_gpio_driver);