1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * GPIO driver for LPC32xx SoC
4 *
5 * Author: Kevin Wells <kevin.wells@nxp.com>
6 *
7 * Copyright (C) 2010 NXP Semiconductors
8 */
9
10 #include <linux/kernel.h>
11 #include <linux/init.h>
12 #include <linux/io.h>
13 #include <linux/errno.h>
14 #include <linux/gpio/driver.h>
15 #include <linux/of.h>
16 #include <linux/platform_device.h>
17 #include <linux/module.h>
18
19 #define LPC32XX_GPIO_P3_INP_STATE (0x000)
20 #define LPC32XX_GPIO_P3_OUTP_SET (0x004)
21 #define LPC32XX_GPIO_P3_OUTP_CLR (0x008)
22 #define LPC32XX_GPIO_P3_OUTP_STATE (0x00C)
23 #define LPC32XX_GPIO_P2_DIR_SET (0x010)
24 #define LPC32XX_GPIO_P2_DIR_CLR (0x014)
25 #define LPC32XX_GPIO_P2_DIR_STATE (0x018)
26 #define LPC32XX_GPIO_P2_INP_STATE (0x01C)
27 #define LPC32XX_GPIO_P2_OUTP_SET (0x020)
28 #define LPC32XX_GPIO_P2_OUTP_CLR (0x024)
29 #define LPC32XX_GPIO_P2_MUX_SET (0x028)
30 #define LPC32XX_GPIO_P2_MUX_CLR (0x02C)
31 #define LPC32XX_GPIO_P2_MUX_STATE (0x030)
32 #define LPC32XX_GPIO_P0_INP_STATE (0x040)
33 #define LPC32XX_GPIO_P0_OUTP_SET (0x044)
34 #define LPC32XX_GPIO_P0_OUTP_CLR (0x048)
35 #define LPC32XX_GPIO_P0_OUTP_STATE (0x04C)
36 #define LPC32XX_GPIO_P0_DIR_SET (0x050)
37 #define LPC32XX_GPIO_P0_DIR_CLR (0x054)
38 #define LPC32XX_GPIO_P0_DIR_STATE (0x058)
39 #define LPC32XX_GPIO_P1_INP_STATE (0x060)
40 #define LPC32XX_GPIO_P1_OUTP_SET (0x064)
41 #define LPC32XX_GPIO_P1_OUTP_CLR (0x068)
42 #define LPC32XX_GPIO_P1_OUTP_STATE (0x06C)
43 #define LPC32XX_GPIO_P1_DIR_SET (0x070)
44 #define LPC32XX_GPIO_P1_DIR_CLR (0x074)
45 #define LPC32XX_GPIO_P1_DIR_STATE (0x078)
46
47 #define GPIO012_PIN_TO_BIT(x) (1 << (x))
48 #define GPIO3_PIN_TO_BIT(x) (1 << ((x) + 25))
49 #define GPO3_PIN_TO_BIT(x) (1 << (x))
50 #define GPIO012_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
51 #define GPIO3_PIN_IN_SHIFT(x) ((x) == 5 ? 24 : 10 + (x))
52 #define GPIO3_PIN_IN_SEL(x, y) (((x) >> GPIO3_PIN_IN_SHIFT(y)) & 1)
53 #define GPIO3_PIN5_IN_SEL(x) (((x) >> 24) & 1)
54 #define GPI3_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
55 #define GPO3_PIN_IN_SEL(x, y) (((x) >> (y)) & 1)
56
57 #define LPC32XX_GPIO_P0_MAX 8
58 #define LPC32XX_GPIO_P1_MAX 24
59 #define LPC32XX_GPIO_P2_MAX 13
60 #define LPC32XX_GPIO_P3_MAX 6
61 #define LPC32XX_GPI_P3_MAX 29
62 #define LPC32XX_GPO_P3_MAX 24
63
64 #define LPC32XX_GPIO_P0_GRP 0
65 #define LPC32XX_GPIO_P1_GRP (LPC32XX_GPIO_P0_GRP + LPC32XX_GPIO_P0_MAX)
66 #define LPC32XX_GPIO_P2_GRP (LPC32XX_GPIO_P1_GRP + LPC32XX_GPIO_P1_MAX)
67 #define LPC32XX_GPIO_P3_GRP (LPC32XX_GPIO_P2_GRP + LPC32XX_GPIO_P2_MAX)
68 #define LPC32XX_GPI_P3_GRP (LPC32XX_GPIO_P3_GRP + LPC32XX_GPIO_P3_MAX)
69 #define LPC32XX_GPO_P3_GRP (LPC32XX_GPI_P3_GRP + LPC32XX_GPI_P3_MAX)
70
71 struct gpio_regs {
72 unsigned long inp_state;
73 unsigned long outp_state;
74 unsigned long outp_set;
75 unsigned long outp_clr;
76 unsigned long dir_set;
77 unsigned long dir_clr;
78 };
79
80 /*
81 * GPIO names
82 */
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"
86 };
87
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",
95 };
96
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"
102 };
103
104 static const char *gpio_p3_names[LPC32XX_GPIO_P3_MAX] = {
105 "gpio00", "gpio01", "gpio02", "gpio03",
106 "gpio04", "gpio05"
107 };
108
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"
118 };
119
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"
127 };
128
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,
135 };
136
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,
143 };
144
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,
151 };
152
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,
160 };
161
162 struct lpc32xx_gpio_chip {
163 struct gpio_chip chip;
164 struct gpio_regs *gpio_grp;
165 void __iomem *reg_base;
166 };
167
gpreg_read(struct lpc32xx_gpio_chip * group,unsigned long offset)168 static inline u32 gpreg_read(struct lpc32xx_gpio_chip *group, unsigned long offset)
169 {
170 return __raw_readl(group->reg_base + offset);
171 }
172
gpreg_write(struct lpc32xx_gpio_chip * group,u32 val,unsigned long offset)173 static inline void gpreg_write(struct lpc32xx_gpio_chip *group, u32 val, unsigned long offset)
174 {
175 __raw_writel(val, group->reg_base + offset);
176 }
177
__set_gpio_dir_p012(struct lpc32xx_gpio_chip * group,unsigned pin,int input)178 static void __set_gpio_dir_p012(struct lpc32xx_gpio_chip *group,
179 unsigned pin, int input)
180 {
181 if (input)
182 gpreg_write(group, GPIO012_PIN_TO_BIT(pin),
183 group->gpio_grp->dir_clr);
184 else
185 gpreg_write(group, GPIO012_PIN_TO_BIT(pin),
186 group->gpio_grp->dir_set);
187 }
188
__set_gpio_dir_p3(struct lpc32xx_gpio_chip * group,unsigned pin,int input)189 static void __set_gpio_dir_p3(struct lpc32xx_gpio_chip *group,
190 unsigned pin, int input)
191 {
192 u32 u = GPIO3_PIN_TO_BIT(pin);
193
194 if (input)
195 gpreg_write(group, u, group->gpio_grp->dir_clr);
196 else
197 gpreg_write(group, u, group->gpio_grp->dir_set);
198 }
199
__set_gpio_level_p012(struct lpc32xx_gpio_chip * group,unsigned pin,int high)200 static void __set_gpio_level_p012(struct lpc32xx_gpio_chip *group,
201 unsigned pin, int high)
202 {
203 if (high)
204 gpreg_write(group, GPIO012_PIN_TO_BIT(pin),
205 group->gpio_grp->outp_set);
206 else
207 gpreg_write(group, GPIO012_PIN_TO_BIT(pin),
208 group->gpio_grp->outp_clr);
209 }
210
__set_gpio_level_p3(struct lpc32xx_gpio_chip * group,unsigned pin,int high)211 static void __set_gpio_level_p3(struct lpc32xx_gpio_chip *group,
212 unsigned pin, int high)
213 {
214 u32 u = GPIO3_PIN_TO_BIT(pin);
215
216 if (high)
217 gpreg_write(group, u, group->gpio_grp->outp_set);
218 else
219 gpreg_write(group, u, group->gpio_grp->outp_clr);
220 }
221
__set_gpo_level_p3(struct lpc32xx_gpio_chip * group,unsigned pin,int high)222 static void __set_gpo_level_p3(struct lpc32xx_gpio_chip *group,
223 unsigned pin, int high)
224 {
225 if (high)
226 gpreg_write(group, GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_set);
227 else
228 gpreg_write(group, GPO3_PIN_TO_BIT(pin), group->gpio_grp->outp_clr);
229 }
230
__get_gpio_state_p012(struct lpc32xx_gpio_chip * group,unsigned pin)231 static int __get_gpio_state_p012(struct lpc32xx_gpio_chip *group,
232 unsigned pin)
233 {
234 return GPIO012_PIN_IN_SEL(gpreg_read(group, group->gpio_grp->inp_state),
235 pin);
236 }
237
__get_gpio_state_p3(struct lpc32xx_gpio_chip * group,unsigned pin)238 static int __get_gpio_state_p3(struct lpc32xx_gpio_chip *group,
239 unsigned pin)
240 {
241 int state = gpreg_read(group, group->gpio_grp->inp_state);
242
243 /*
244 * P3 GPIO pin input mapping is not contiguous, GPIOP3-0..4 is mapped
245 * to bits 10..14, while GPIOP3-5 is mapped to bit 24.
246 */
247 return GPIO3_PIN_IN_SEL(state, pin);
248 }
249
__get_gpi_state_p3(struct lpc32xx_gpio_chip * group,unsigned pin)250 static int __get_gpi_state_p3(struct lpc32xx_gpio_chip *group,
251 unsigned pin)
252 {
253 return GPI3_PIN_IN_SEL(gpreg_read(group, group->gpio_grp->inp_state), pin);
254 }
255
__get_gpo_state_p3(struct lpc32xx_gpio_chip * group,unsigned pin)256 static int __get_gpo_state_p3(struct lpc32xx_gpio_chip *group,
257 unsigned pin)
258 {
259 return GPO3_PIN_IN_SEL(gpreg_read(group, group->gpio_grp->outp_state), pin);
260 }
261
262 /*
263 * GPIO primitives.
264 */
lpc32xx_gpio_dir_input_p012(struct gpio_chip * chip,unsigned pin)265 static int lpc32xx_gpio_dir_input_p012(struct gpio_chip *chip,
266 unsigned pin)
267 {
268 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
269
270 __set_gpio_dir_p012(group, pin, 1);
271
272 return 0;
273 }
274
lpc32xx_gpio_dir_input_p3(struct gpio_chip * chip,unsigned pin)275 static int lpc32xx_gpio_dir_input_p3(struct gpio_chip *chip,
276 unsigned pin)
277 {
278 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
279
280 __set_gpio_dir_p3(group, pin, 1);
281
282 return 0;
283 }
284
lpc32xx_gpio_dir_in_always(struct gpio_chip * chip,unsigned pin)285 static int lpc32xx_gpio_dir_in_always(struct gpio_chip *chip,
286 unsigned pin)
287 {
288 return 0;
289 }
290
lpc32xx_gpio_get_value_p012(struct gpio_chip * chip,unsigned pin)291 static int lpc32xx_gpio_get_value_p012(struct gpio_chip *chip, unsigned pin)
292 {
293 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
294
295 return !!__get_gpio_state_p012(group, pin);
296 }
297
lpc32xx_gpio_get_value_p3(struct gpio_chip * chip,unsigned pin)298 static int lpc32xx_gpio_get_value_p3(struct gpio_chip *chip, unsigned pin)
299 {
300 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
301
302 return !!__get_gpio_state_p3(group, pin);
303 }
304
lpc32xx_gpi_get_value(struct gpio_chip * chip,unsigned pin)305 static int lpc32xx_gpi_get_value(struct gpio_chip *chip, unsigned pin)
306 {
307 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
308
309 return !!__get_gpi_state_p3(group, pin);
310 }
311
lpc32xx_gpio_dir_output_p012(struct gpio_chip * chip,unsigned pin,int value)312 static int lpc32xx_gpio_dir_output_p012(struct gpio_chip *chip, unsigned pin,
313 int value)
314 {
315 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
316
317 __set_gpio_level_p012(group, pin, value);
318 __set_gpio_dir_p012(group, pin, 0);
319
320 return 0;
321 }
322
lpc32xx_gpio_dir_output_p3(struct gpio_chip * chip,unsigned pin,int value)323 static int lpc32xx_gpio_dir_output_p3(struct gpio_chip *chip, unsigned pin,
324 int value)
325 {
326 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
327
328 __set_gpio_level_p3(group, pin, value);
329 __set_gpio_dir_p3(group, pin, 0);
330
331 return 0;
332 }
333
lpc32xx_gpio_dir_out_always(struct gpio_chip * chip,unsigned pin,int value)334 static int lpc32xx_gpio_dir_out_always(struct gpio_chip *chip, unsigned pin,
335 int value)
336 {
337 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
338
339 __set_gpo_level_p3(group, pin, value);
340 return 0;
341 }
342
lpc32xx_gpio_set_value_p012(struct gpio_chip * chip,unsigned int pin,int value)343 static int lpc32xx_gpio_set_value_p012(struct gpio_chip *chip,
344 unsigned int pin, int value)
345 {
346 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
347
348 __set_gpio_level_p012(group, pin, value);
349
350 return 0;
351 }
352
lpc32xx_gpio_set_value_p3(struct gpio_chip * chip,unsigned int pin,int value)353 static int lpc32xx_gpio_set_value_p3(struct gpio_chip *chip,
354 unsigned int pin, int value)
355 {
356 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
357
358 __set_gpio_level_p3(group, pin, value);
359
360 return 0;
361 }
362
lpc32xx_gpo_set_value(struct gpio_chip * chip,unsigned int pin,int value)363 static int lpc32xx_gpo_set_value(struct gpio_chip *chip, unsigned int pin,
364 int value)
365 {
366 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
367
368 __set_gpo_level_p3(group, pin, value);
369
370 return 0;
371 }
372
lpc32xx_gpo_get_value(struct gpio_chip * chip,unsigned pin)373 static int lpc32xx_gpo_get_value(struct gpio_chip *chip, unsigned pin)
374 {
375 struct lpc32xx_gpio_chip *group = gpiochip_get_data(chip);
376
377 return !!__get_gpo_state_p3(group, pin);
378 }
379
lpc32xx_gpio_request(struct gpio_chip * chip,unsigned pin)380 static int lpc32xx_gpio_request(struct gpio_chip *chip, unsigned pin)
381 {
382 if (pin < chip->ngpio)
383 return 0;
384
385 return -EINVAL;
386 }
387
lpc32xx_gpio_to_irq_p01(struct gpio_chip * chip,unsigned offset)388 static int lpc32xx_gpio_to_irq_p01(struct gpio_chip *chip, unsigned offset)
389 {
390 return -ENXIO;
391 }
392
lpc32xx_gpio_to_irq_gpio_p3(struct gpio_chip * chip,unsigned offset)393 static int lpc32xx_gpio_to_irq_gpio_p3(struct gpio_chip *chip, unsigned offset)
394 {
395 return -ENXIO;
396 }
397
lpc32xx_gpio_to_irq_gpi_p3(struct gpio_chip * chip,unsigned offset)398 static int lpc32xx_gpio_to_irq_gpi_p3(struct gpio_chip *chip, unsigned offset)
399 {
400 return -ENXIO;
401 }
402
403 static struct lpc32xx_gpio_chip lpc32xx_gpiochip[] = {
404 {
405 .chip = {
406 .label = "gpio_p0",
407 .direction_input = lpc32xx_gpio_dir_input_p012,
408 .get = lpc32xx_gpio_get_value_p012,
409 .direction_output = lpc32xx_gpio_dir_output_p012,
410 .set_rv = lpc32xx_gpio_set_value_p012,
411 .request = lpc32xx_gpio_request,
412 .to_irq = lpc32xx_gpio_to_irq_p01,
413 .base = LPC32XX_GPIO_P0_GRP,
414 .ngpio = LPC32XX_GPIO_P0_MAX,
415 .names = gpio_p0_names,
416 .can_sleep = false,
417 },
418 .gpio_grp = &gpio_grp_regs_p0,
419 },
420 {
421 .chip = {
422 .label = "gpio_p1",
423 .direction_input = lpc32xx_gpio_dir_input_p012,
424 .get = lpc32xx_gpio_get_value_p012,
425 .direction_output = lpc32xx_gpio_dir_output_p012,
426 .set_rv = lpc32xx_gpio_set_value_p012,
427 .request = lpc32xx_gpio_request,
428 .to_irq = lpc32xx_gpio_to_irq_p01,
429 .base = LPC32XX_GPIO_P1_GRP,
430 .ngpio = LPC32XX_GPIO_P1_MAX,
431 .names = gpio_p1_names,
432 .can_sleep = false,
433 },
434 .gpio_grp = &gpio_grp_regs_p1,
435 },
436 {
437 .chip = {
438 .label = "gpio_p2",
439 .direction_input = lpc32xx_gpio_dir_input_p012,
440 .get = lpc32xx_gpio_get_value_p012,
441 .direction_output = lpc32xx_gpio_dir_output_p012,
442 .set_rv = lpc32xx_gpio_set_value_p012,
443 .request = lpc32xx_gpio_request,
444 .base = LPC32XX_GPIO_P2_GRP,
445 .ngpio = LPC32XX_GPIO_P2_MAX,
446 .names = gpio_p2_names,
447 .can_sleep = false,
448 },
449 .gpio_grp = &gpio_grp_regs_p2,
450 },
451 {
452 .chip = {
453 .label = "gpio_p3",
454 .direction_input = lpc32xx_gpio_dir_input_p3,
455 .get = lpc32xx_gpio_get_value_p3,
456 .direction_output = lpc32xx_gpio_dir_output_p3,
457 .set_rv = lpc32xx_gpio_set_value_p3,
458 .request = lpc32xx_gpio_request,
459 .to_irq = lpc32xx_gpio_to_irq_gpio_p3,
460 .base = LPC32XX_GPIO_P3_GRP,
461 .ngpio = LPC32XX_GPIO_P3_MAX,
462 .names = gpio_p3_names,
463 .can_sleep = false,
464 },
465 .gpio_grp = &gpio_grp_regs_p3,
466 },
467 {
468 .chip = {
469 .label = "gpi_p3",
470 .direction_input = lpc32xx_gpio_dir_in_always,
471 .get = lpc32xx_gpi_get_value,
472 .request = lpc32xx_gpio_request,
473 .to_irq = lpc32xx_gpio_to_irq_gpi_p3,
474 .base = LPC32XX_GPI_P3_GRP,
475 .ngpio = LPC32XX_GPI_P3_MAX,
476 .names = gpi_p3_names,
477 .can_sleep = false,
478 },
479 .gpio_grp = &gpio_grp_regs_p3,
480 },
481 {
482 .chip = {
483 .label = "gpo_p3",
484 .direction_output = lpc32xx_gpio_dir_out_always,
485 .set_rv = lpc32xx_gpo_set_value,
486 .get = lpc32xx_gpo_get_value,
487 .request = lpc32xx_gpio_request,
488 .base = LPC32XX_GPO_P3_GRP,
489 .ngpio = LPC32XX_GPO_P3_MAX,
490 .names = gpo_p3_names,
491 .can_sleep = false,
492 },
493 .gpio_grp = &gpio_grp_regs_p3,
494 },
495 };
496
lpc32xx_of_xlate(struct gpio_chip * gc,const struct of_phandle_args * gpiospec,u32 * flags)497 static int lpc32xx_of_xlate(struct gpio_chip *gc,
498 const struct of_phandle_args *gpiospec, u32 *flags)
499 {
500 /* Is this the correct bank? */
501 u32 bank = gpiospec->args[0];
502 if ((bank >= ARRAY_SIZE(lpc32xx_gpiochip) ||
503 (gc != &lpc32xx_gpiochip[bank].chip)))
504 return -EINVAL;
505
506 if (flags)
507 *flags = gpiospec->args[2];
508 return gpiospec->args[1];
509 }
510
lpc32xx_gpio_probe(struct platform_device * pdev)511 static int lpc32xx_gpio_probe(struct platform_device *pdev)
512 {
513 int i;
514 void __iomem *reg_base;
515
516 reg_base = devm_platform_ioremap_resource(pdev, 0);
517 if (IS_ERR(reg_base))
518 return PTR_ERR(reg_base);
519
520 for (i = 0; i < ARRAY_SIZE(lpc32xx_gpiochip); i++) {
521 lpc32xx_gpiochip[i].chip.parent = &pdev->dev;
522 if (pdev->dev.of_node) {
523 lpc32xx_gpiochip[i].chip.of_xlate = lpc32xx_of_xlate;
524 lpc32xx_gpiochip[i].chip.of_gpio_n_cells = 3;
525 lpc32xx_gpiochip[i].reg_base = reg_base;
526 }
527 devm_gpiochip_add_data(&pdev->dev, &lpc32xx_gpiochip[i].chip,
528 &lpc32xx_gpiochip[i]);
529 }
530
531 return 0;
532 }
533
534 static const struct of_device_id lpc32xx_gpio_of_match[] = {
535 { .compatible = "nxp,lpc3220-gpio", },
536 { },
537 };
538 MODULE_DEVICE_TABLE(of, lpc32xx_gpio_of_match);
539
540 static struct platform_driver lpc32xx_gpio_driver = {
541 .driver = {
542 .name = "lpc32xx-gpio",
543 .of_match_table = lpc32xx_gpio_of_match,
544 },
545 .probe = lpc32xx_gpio_probe,
546 };
547
548 module_platform_driver(lpc32xx_gpio_driver);
549
550 MODULE_AUTHOR("Kevin Wells <kevin.wells@nxp.com>");
551 MODULE_LICENSE("GPL");
552 MODULE_DESCRIPTION("GPIO driver for LPC32xx SoC");
553