bpf: fix htab map destruction when extra reserve is in use
[linux/fpc-iii.git] / drivers / gpio / gpio-lpc32xx.c
blobfc5f197906ac97b09b14617ca56d52896b59453a
1 /*
2 * GPIO driver for LPC32xx SoC
4 * Author: Kevin Wells <kevin.wells@nxp.com>
6 * Copyright (C) 2010 NXP Semiconductors
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.
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.
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 #include <linux/platform_data/gpio-lpc32xx.h>
30 #include <mach/hardware.h>
31 #include <mach/platform.h>
33 #define LPC32XX_GPIO_P3_INP_STATE _GPREG(0x000)
34 #define LPC32XX_GPIO_P3_OUTP_SET _GPREG(0x004)
35 #define LPC32XX_GPIO_P3_OUTP_CLR _GPREG(0x008)
36 #define LPC32XX_GPIO_P3_OUTP_STATE _GPREG(0x00C)
37 #define LPC32XX_GPIO_P2_DIR_SET _GPREG(0x010)
38 #define LPC32XX_GPIO_P2_DIR_CLR _GPREG(0x014)
39 #define LPC32XX_GPIO_P2_DIR_STATE _GPREG(0x018)
40 #define LPC32XX_GPIO_P2_INP_STATE _GPREG(0x01C)
41 #define LPC32XX_GPIO_P2_OUTP_SET _GPREG(0x020)
42 #define LPC32XX_GPIO_P2_OUTP_CLR _GPREG(0x024)
43 #define LPC32XX_GPIO_P2_MUX_SET _GPREG(0x028)
44 #define LPC32XX_GPIO_P2_MUX_CLR _GPREG(0x02C)
45 #define LPC32XX_GPIO_P2_MUX_STATE _GPREG(0x030)
46 #define LPC32XX_GPIO_P0_INP_STATE _GPREG(0x040)
47 #define LPC32XX_GPIO_P0_OUTP_SET _GPREG(0x044)
48 #define LPC32XX_GPIO_P0_OUTP_CLR _GPREG(0x048)
49 #define LPC32XX_GPIO_P0_OUTP_STATE _GPREG(0x04C)
50 #define LPC32XX_GPIO_P0_DIR_SET _GPREG(0x050)
51 #define LPC32XX_GPIO_P0_DIR_CLR _GPREG(0x054)
52 #define LPC32XX_GPIO_P0_DIR_STATE _GPREG(0x058)
53 #define LPC32XX_GPIO_P1_INP_STATE _GPREG(0x060)
54 #define LPC32XX_GPIO_P1_OUTP_SET _GPREG(0x064)
55 #define LPC32XX_GPIO_P1_OUTP_CLR _GPREG(0x068)
56 #define LPC32XX_GPIO_P1_OUTP_STATE _GPREG(0x06C)
57 #define LPC32XX_GPIO_P1_DIR_SET _GPREG(0x070)
58 #define LPC32XX_GPIO_P1_DIR_CLR _GPREG(0x074)
59 #define LPC32XX_GPIO_P1_DIR_STATE _GPREG(0x078)
61 #define GPIO012_PIN_TO_BIT(x) (1 << (x))
62 #define GPIO3_PIN_TO_BIT(x) (1 << ((x) + 25))
63 #define GPO3_PIN_TO_BIT(x) (1 << (x))
64 #define GPIO012_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
65 #define GPIO3_PIN_IN_SHIFT(x) ((x) == 5 ? 24 : 10 + (x))
66 #define GPIO3_PIN_IN_SEL(x, y) (((x) >> GPIO3_PIN_IN_SHIFT(y)) & 1)
67 #define GPIO3_PIN5_IN_SEL(x) (((x) >> 24) & 1)
68 #define GPI3_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
69 #define GPO3_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
71 struct gpio_regs {
72 void __iomem *inp_state;
73 void __iomem *outp_state;
74 void __iomem *outp_set;
75 void __iomem *outp_clr;
76 void __iomem *dir_set;
77 void __iomem *dir_clr;
81 * GPIO names
83 static const char *gpio_p0_names[LPC32XX_GPIO_P0_MAX] = {
84 "p0.0", "p0.1", "p0.2", "p0.3",
85 "p0.4", "p0.5", "p0.6", "p0.7"
88 static const char *gpio_p1_names[LPC32XX_GPIO_P1_MAX] = {
89 "p1.0", "p1.1", "p1.2", "p1.3",
90 "p1.4", "p1.5", "p1.6", "p1.7",
91 "p1.8", "p1.9", "p1.10", "p1.11",
92 "p1.12", "p1.13", "p1.14", "p1.15",
93 "p1.16", "p1.17", "p1.18", "p1.19",
94 "p1.20", "p1.21", "p1.22", "p1.23",
97 static const char *gpio_p2_names[LPC32XX_GPIO_P2_MAX] = {
98 "p2.0", "p2.1", "p2.2", "p2.3",
99 "p2.4", "p2.5", "p2.6", "p2.7",
100 "p2.8", "p2.9", "p2.10", "p2.11",
101 "p2.12"
104 static const char *gpio_p3_names[LPC32XX_GPIO_P3_MAX] = {
105 "gpio00", "gpio01", "gpio02", "gpio03",
106 "gpio04", "gpio05"
109 static const char *gpi_p3_names[LPC32XX_GPI_P3_MAX] = {
110 "gpi00", "gpi01", "gpi02", "gpi03",
111 "gpi04", "gpi05", "gpi06", "gpi07",
112 "gpi08", "gpi09", NULL, NULL,
113 NULL, NULL, NULL, "gpi15",
114 "gpi16", "gpi17", "gpi18", "gpi19",
115 "gpi20", "gpi21", "gpi22", "gpi23",
116 "gpi24", "gpi25", "gpi26", "gpi27",
117 "gpi28"
120 static const char *gpo_p3_names[LPC32XX_GPO_P3_MAX] = {
121 "gpo00", "gpo01", "gpo02", "gpo03",
122 "gpo04", "gpo05", "gpo06", "gpo07",
123 "gpo08", "gpo09", "gpo10", "gpo11",
124 "gpo12", "gpo13", "gpo14", "gpo15",
125 "gpo16", "gpo17", "gpo18", "gpo19",
126 "gpo20", "gpo21", "gpo22", "gpo23"
129 static struct gpio_regs gpio_grp_regs_p0 = {
130 .inp_state = LPC32XX_GPIO_P0_INP_STATE,
131 .outp_set = LPC32XX_GPIO_P0_OUTP_SET,
132 .outp_clr = LPC32XX_GPIO_P0_OUTP_CLR,
133 .dir_set = LPC32XX_GPIO_P0_DIR_SET,
134 .dir_clr = LPC32XX_GPIO_P0_DIR_CLR,
137 static struct gpio_regs gpio_grp_regs_p1 = {
138 .inp_state = LPC32XX_GPIO_P1_INP_STATE,
139 .outp_set = LPC32XX_GPIO_P1_OUTP_SET,
140 .outp_clr = LPC32XX_GPIO_P1_OUTP_CLR,
141 .dir_set = LPC32XX_GPIO_P1_DIR_SET,
142 .dir_clr = LPC32XX_GPIO_P1_DIR_CLR,
145 static struct gpio_regs gpio_grp_regs_p2 = {
146 .inp_state = LPC32XX_GPIO_P2_INP_STATE,
147 .outp_set = LPC32XX_GPIO_P2_OUTP_SET,
148 .outp_clr = LPC32XX_GPIO_P2_OUTP_CLR,
149 .dir_set = LPC32XX_GPIO_P2_DIR_SET,
150 .dir_clr = LPC32XX_GPIO_P2_DIR_CLR,
153 static struct gpio_regs gpio_grp_regs_p3 = {
154 .inp_state = LPC32XX_GPIO_P3_INP_STATE,
155 .outp_state = LPC32XX_GPIO_P3_OUTP_STATE,
156 .outp_set = LPC32XX_GPIO_P3_OUTP_SET,
157 .outp_clr = LPC32XX_GPIO_P3_OUTP_CLR,
158 .dir_set = LPC32XX_GPIO_P2_DIR_SET,
159 .dir_clr = LPC32XX_GPIO_P2_DIR_CLR,
162 struct lpc32xx_gpio_chip {
163 struct gpio_chip chip;
164 struct gpio_regs *gpio_grp;
167 static void __set_gpio_dir_p012(struct lpc32xx_gpio_chip *group,
168 unsigned pin, int input)
170 if (input)
171 __raw_writel(GPIO012_PIN_TO_BIT(pin),
172 group->gpio_grp->dir_clr);
173 else
174 __raw_writel(GPIO012_PIN_TO_BIT(pin),
175 group->gpio_grp->dir_set);
178 static void __set_gpio_dir_p3(struct lpc32xx_gpio_chip *group,
179 unsigned pin, int input)
181 u32 u = GPIO3_PIN_TO_BIT(pin);
183 if (input)
184 __raw_writel(u, group->gpio_grp->dir_clr);
185 else
186 __raw_writel(u, group->gpio_grp->dir_set);
189 static void __set_gpio_level_p012(struct lpc32xx_gpio_chip *group,
190 unsigned pin, int high)
192 if (high)
193 __raw_writel(GPIO012_PIN_TO_BIT(pin),
194 group->gpio_grp->outp_set);
195 else
196 __raw_writel(GPIO012_PIN_TO_BIT(pin),
197 group->gpio_grp->outp_clr);
200 static void __set_gpio_level_p3(struct lpc32xx_gpio_chip *group,
201 unsigned pin, int high)
203 u32 u = GPIO3_PIN_TO_BIT(pin);
205 if (high)
206 __raw_writel(u, group->gpio_grp->outp_set);
207 else
208 __raw_writel(u, group->gpio_grp->outp_clr);
211 static void __set_gpo_level_p3(struct lpc32xx_gpio_chip *group,
212 unsigned pin, int high)
214 if (high)
215 __raw_writel(GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_set);
216 else
217 __raw_writel(GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_clr);
220 static int __get_gpio_state_p012(struct lpc32xx_gpio_chip *group,
221 unsigned pin)
223 return GPIO012_PIN_IN_SEL(__raw_readl(group->gpio_grp->inp_state),
224 pin);
227 static int __get_gpio_state_p3(struct lpc32xx_gpio_chip *group,
228 unsigned pin)
230 int state = __raw_readl(group->gpio_grp->inp_state);
233 * P3 GPIO pin input mapping is not contiguous, GPIOP3-0..4 is mapped
234 * to bits 10..14, while GPIOP3-5 is mapped to bit 24.
236 return GPIO3_PIN_IN_SEL(state, pin);
239 static int __get_gpi_state_p3(struct lpc32xx_gpio_chip *group,
240 unsigned pin)
242 return GPI3_PIN_IN_SEL(__raw_readl(group->gpio_grp->inp_state), pin);
245 static int __get_gpo_state_p3(struct lpc32xx_gpio_chip *group,
246 unsigned pin)
248 return GPO3_PIN_IN_SEL(__raw_readl(group->gpio_grp->outp_state), pin);
252 * GPIO primitives.
254 static int lpc32xx_gpio_dir_input_p012(struct gpio_chip *chip,
255 unsigned pin)
257 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
259 __set_gpio_dir_p012(group, pin, 1);
261 return 0;
264 static int lpc32xx_gpio_dir_input_p3(struct gpio_chip *chip,
265 unsigned pin)
267 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
269 __set_gpio_dir_p3(group, pin, 1);
271 return 0;
274 static int lpc32xx_gpio_dir_in_always(struct gpio_chip *chip,
275 unsigned pin)
277 return 0;
280 static int lpc32xx_gpio_get_value_p012(struct gpio_chip *chip, unsigned pin)
282 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
284 return !!__get_gpio_state_p012(group, pin);
287 static int lpc32xx_gpio_get_value_p3(struct gpio_chip *chip, unsigned pin)
289 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
291 return !!__get_gpio_state_p3(group, pin);
294 static int lpc32xx_gpi_get_value(struct gpio_chip *chip, unsigned pin)
296 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
298 return !!__get_gpi_state_p3(group, pin);
301 static int lpc32xx_gpio_dir_output_p012(struct gpio_chip *chip, unsigned pin,
302 int value)
304 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
306 __set_gpio_level_p012(group, pin, value);
307 __set_gpio_dir_p012(group, pin, 0);
309 return 0;
312 static int lpc32xx_gpio_dir_output_p3(struct gpio_chip *chip, unsigned pin,
313 int value)
315 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
317 __set_gpio_level_p3(group, pin, value);
318 __set_gpio_dir_p3(group, pin, 0);
320 return 0;
323 static int lpc32xx_gpio_dir_out_always(struct gpio_chip *chip, unsigned pin,
324 int value)
326 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
328 __set_gpo_level_p3(group, pin, value);
329 return 0;
332 static void lpc32xx_gpio_set_value_p012(struct gpio_chip *chip, unsigned pin,
333 int value)
335 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
337 __set_gpio_level_p012(group, pin, value);
340 static void lpc32xx_gpio_set_value_p3(struct gpio_chip *chip, unsigned pin,
341 int value)
343 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
345 __set_gpio_level_p3(group, pin, value);
348 static void lpc32xx_gpo_set_value(struct gpio_chip *chip, unsigned pin,
349 int value)
351 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
353 __set_gpo_level_p3(group, pin, value);
356 static int lpc32xx_gpo_get_value(struct gpio_chip *chip, unsigned pin)
358 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
360 return !!__get_gpo_state_p3(group, pin);
363 static int lpc32xx_gpio_request(struct gpio_chip *chip, unsigned pin)
365 if (pin < chip->ngpio)
366 return 0;
368 return -EINVAL;
371 static int lpc32xx_gpio_to_irq_p01(struct gpio_chip *chip, unsigned offset)
373 return -ENXIO;
376 static int lpc32xx_gpio_to_irq_gpio_p3(struct gpio_chip *chip, unsigned offset)
378 return -ENXIO;
381 static int lpc32xx_gpio_to_irq_gpi_p3(struct gpio_chip *chip, unsigned offset)
383 return -ENXIO;
386 static struct lpc32xx_gpio_chip lpc32xx_gpiochip[] = {
388 .chip = {
389 .label = "gpio_p0",
390 .direction_input = lpc32xx_gpio_dir_input_p012,
391 .get = lpc32xx_gpio_get_value_p012,
392 .direction_output = lpc32xx_gpio_dir_output_p012,
393 .set = lpc32xx_gpio_set_value_p012,
394 .request = lpc32xx_gpio_request,
395 .to_irq = lpc32xx_gpio_to_irq_p01,
396 .base = LPC32XX_GPIO_P0_GRP,
397 .ngpio = LPC32XX_GPIO_P0_MAX,
398 .names = gpio_p0_names,
399 .can_sleep = false,
401 .gpio_grp = &gpio_grp_regs_p0,
404 .chip = {
405 .label = "gpio_p1",
406 .direction_input = lpc32xx_gpio_dir_input_p012,
407 .get = lpc32xx_gpio_get_value_p012,
408 .direction_output = lpc32xx_gpio_dir_output_p012,
409 .set = lpc32xx_gpio_set_value_p012,
410 .request = lpc32xx_gpio_request,
411 .to_irq = lpc32xx_gpio_to_irq_p01,
412 .base = LPC32XX_GPIO_P1_GRP,
413 .ngpio = LPC32XX_GPIO_P1_MAX,
414 .names = gpio_p1_names,
415 .can_sleep = false,
417 .gpio_grp = &gpio_grp_regs_p1,
420 .chip = {
421 .label = "gpio_p2",
422 .direction_input = lpc32xx_gpio_dir_input_p012,
423 .get = lpc32xx_gpio_get_value_p012,
424 .direction_output = lpc32xx_gpio_dir_output_p012,
425 .set = lpc32xx_gpio_set_value_p012,
426 .request = lpc32xx_gpio_request,
427 .base = LPC32XX_GPIO_P2_GRP,
428 .ngpio = LPC32XX_GPIO_P2_MAX,
429 .names = gpio_p2_names,
430 .can_sleep = false,
432 .gpio_grp = &gpio_grp_regs_p2,
435 .chip = {
436 .label = "gpio_p3",
437 .direction_input = lpc32xx_gpio_dir_input_p3,
438 .get = lpc32xx_gpio_get_value_p3,
439 .direction_output = lpc32xx_gpio_dir_output_p3,
440 .set = lpc32xx_gpio_set_value_p3,
441 .request = lpc32xx_gpio_request,
442 .to_irq = lpc32xx_gpio_to_irq_gpio_p3,
443 .base = LPC32XX_GPIO_P3_GRP,
444 .ngpio = LPC32XX_GPIO_P3_MAX,
445 .names = gpio_p3_names,
446 .can_sleep = false,
448 .gpio_grp = &gpio_grp_regs_p3,
451 .chip = {
452 .label = "gpi_p3",
453 .direction_input = lpc32xx_gpio_dir_in_always,
454 .get = lpc32xx_gpi_get_value,
455 .request = lpc32xx_gpio_request,
456 .to_irq = lpc32xx_gpio_to_irq_gpi_p3,
457 .base = LPC32XX_GPI_P3_GRP,
458 .ngpio = LPC32XX_GPI_P3_MAX,
459 .names = gpi_p3_names,
460 .can_sleep = false,
462 .gpio_grp = &gpio_grp_regs_p3,
465 .chip = {
466 .label = "gpo_p3",
467 .direction_output = lpc32xx_gpio_dir_out_always,
468 .set = lpc32xx_gpo_set_value,
469 .get = lpc32xx_gpo_get_value,
470 .request = lpc32xx_gpio_request,
471 .base = LPC32XX_GPO_P3_GRP,
472 .ngpio = LPC32XX_GPO_P3_MAX,
473 .names = gpo_p3_names,
474 .can_sleep = false,
476 .gpio_grp = &gpio_grp_regs_p3,
480 static int lpc32xx_of_xlate(struct gpio_chip *gc,
481 const struct of_phandle_args *gpiospec, u32 *flags)
483 /* Is this the correct bank? */
484 u32 bank = gpiospec->args[0];
485 if ((bank >= ARRAY_SIZE(lpc32xx_gpiochip) ||
486 (gc != &lpc32xx_gpiochip[bank].chip)))
487 return -EINVAL;
489 if (flags)
490 *flags = gpiospec->args[2];
491 return gpiospec->args[1];
494 static int lpc32xx_gpio_probe(struct platform_device *pdev)
496 int i;
498 for (i = 0; i < ARRAY_SIZE(lpc32xx_gpiochip); i++) {
499 if (pdev->dev.of_node) {
500 lpc32xx_gpiochip[i].chip.of_xlate = lpc32xx_of_xlate;
501 lpc32xx_gpiochip[i].chip.of_gpio_n_cells = 3;
502 lpc32xx_gpiochip[i].chip.of_node = pdev->dev.of_node;
504 devm_gpiochip_add_data(&pdev->dev, &lpc32xx_gpiochip[i].chip,
505 &lpc32xx_gpiochip[i]);
508 return 0;
511 #ifdef CONFIG_OF
512 static const struct of_device_id lpc32xx_gpio_of_match[] = {
513 { .compatible = "nxp,lpc3220-gpio", },
514 { },
516 #endif
518 static struct platform_driver lpc32xx_gpio_driver = {
519 .driver = {
520 .name = "lpc32xx-gpio",
521 .of_match_table = of_match_ptr(lpc32xx_gpio_of_match),
523 .probe = lpc32xx_gpio_probe,
526 module_platform_driver(lpc32xx_gpio_driver);