?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
PM / sleep: Asynchronous threads for suspend_noirq
[linux/fpc-iii.git] / drivers / pinctrl / pinctrl-s3c64xx.c
blob89143c90300064f2e98d37d29d08164aa4a42b9b
1 /*
2 * S3C64xx specific support for pinctrl-samsung driver.
3 *
4 * Copyright (c) 2013 Tomasz Figa <tomasz.figa@gmail.com>
5 *
6 * Based on pinctrl-exynos.c, please see the file for original copyrights.
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 file contains the Samsung S3C64xx specific information required by the
14 * the Samsung pinctrl/gpiolib driver. It also includes the implementation of
15 * external gpio and wakeup interrupt support.
16 */
17
18 #include <linux/module.h>
19 #include <linux/device.h>
20 #include <linux/interrupt.h>
21 #include <linux/irqdomain.h>
22 #include <linux/irq.h>
23 #include <linux/of_irq.h>
24 #include <linux/io.h>
25 #include <linux/irqchip/chained_irq.h>
26 #include <linux/slab.h>
27 #include <linux/err.h>
28
29 #include "pinctrl-samsung.h"
30
31 #define NUM_EINT0 28
32 #define NUM_EINT0_IRQ 4
33 #define EINT_MAX_PER_REG 16
34 #define EINT_MAX_PER_GROUP 16
35
36 /* External GPIO and wakeup interrupt related definitions */
37 #define SVC_GROUP_SHIFT 4
38 #define SVC_GROUP_MASK 0xf
39 #define SVC_NUM_MASK 0xf
40 #define SVC_GROUP(x) ((x >> SVC_GROUP_SHIFT) & \
41 SVC_GROUP_MASK)
42
43 #define EINT12CON_REG 0x200
44 #define EINT12MASK_REG 0x240
45 #define EINT12PEND_REG 0x260
46
47 #define EINT_OFFS(i) ((i) % (2 * EINT_MAX_PER_GROUP))
48 #define EINT_GROUP(i) ((i) / EINT_MAX_PER_GROUP)
49 #define EINT_REG(g) (4 * ((g) / 2))
50
51 #define EINTCON_REG(i) (EINT12CON_REG + EINT_REG(EINT_GROUP(i)))
52 #define EINTMASK_REG(i) (EINT12MASK_REG + EINT_REG(EINT_GROUP(i)))
53 #define EINTPEND_REG(i) (EINT12PEND_REG + EINT_REG(EINT_GROUP(i)))
54
55 #define SERVICE_REG 0x284
56 #define SERVICEPEND_REG 0x288
57
58 #define EINT0CON0_REG 0x900
59 #define EINT0MASK_REG 0x920
60 #define EINT0PEND_REG 0x924
61
62 /* S3C64xx specific external interrupt trigger types */
63 #define EINT_LEVEL_LOW 0
64 #define EINT_LEVEL_HIGH 1
65 #define EINT_EDGE_FALLING 2
66 #define EINT_EDGE_RISING 4
67 #define EINT_EDGE_BOTH 6
68 #define EINT_CON_MASK 0xF
69 #define EINT_CON_LEN 4
70
71 static struct samsung_pin_bank_type bank_type_4bit_off = {
72 .fld_width = { 4, 1, 2, 0, 2, 2, },
73 .reg_offset = { 0x00, 0x04, 0x08, 0, 0x0c, 0x10, },
74 };
75
76 static struct samsung_pin_bank_type bank_type_4bit_alive = {
77 .fld_width = { 4, 1, 2, },
78 .reg_offset = { 0x00, 0x04, 0x08, },
79 };
80
81 static struct samsung_pin_bank_type bank_type_4bit2_off = {
82 .fld_width = { 4, 1, 2, 0, 2, 2, },
83 .reg_offset = { 0x00, 0x08, 0x0c, 0, 0x10, 0x14, },
84 };
85
86 static struct samsung_pin_bank_type bank_type_4bit2_alive = {
87 .fld_width = { 4, 1, 2, },
88 .reg_offset = { 0x00, 0x08, 0x0c, },
89 };
90
91 static struct samsung_pin_bank_type bank_type_2bit_off = {
92 .fld_width = { 2, 1, 2, 0, 2, 2, },
93 .reg_offset = { 0x00, 0x04, 0x08, 0, 0x0c, 0x10, },
94 };
95
96 static struct samsung_pin_bank_type bank_type_2bit_alive = {
97 .fld_width = { 2, 1, 2, },
98 .reg_offset = { 0x00, 0x04, 0x08, },
99 };
100
101 #define PIN_BANK_4BIT(pins, reg, id) \
102 { \
103 .type = &bank_type_4bit_off, \
104 .pctl_offset = reg, \
105 .nr_pins = pins, \
106 .eint_type = EINT_TYPE_NONE, \
107 .name = id \
108 }
109
110 #define PIN_BANK_4BIT_EINTG(pins, reg, id, eoffs) \
111 { \
112 .type = &bank_type_4bit_off, \
113 .pctl_offset = reg, \
114 .nr_pins = pins, \
115 .eint_type = EINT_TYPE_GPIO, \
116 .eint_func = 7, \
117 .eint_mask = (1 << (pins)) - 1, \
118 .eint_offset = eoffs, \
119 .name = id \
120 }
121
122 #define PIN_BANK_4BIT_EINTW(pins, reg, id, eoffs, emask) \
123 { \
124 .type = &bank_type_4bit_alive,\
125 .pctl_offset = reg, \
126 .nr_pins = pins, \
127 .eint_type = EINT_TYPE_WKUP, \
128 .eint_func = 3, \
129 .eint_mask = emask, \
130 .eint_offset = eoffs, \
131 .name = id \
132 }
133
134 #define PIN_BANK_4BIT2_EINTG(pins, reg, id, eoffs) \
135 { \
136 .type = &bank_type_4bit2_off, \
137 .pctl_offset = reg, \
138 .nr_pins = pins, \
139 .eint_type = EINT_TYPE_GPIO, \
140 .eint_func = 7, \
141 .eint_mask = (1 << (pins)) - 1, \
142 .eint_offset = eoffs, \
143 .name = id \
144 }
145
146 #define PIN_BANK_4BIT2_EINTW(pins, reg, id, eoffs, emask) \
147 { \
148 .type = &bank_type_4bit2_alive,\
149 .pctl_offset = reg, \
150 .nr_pins = pins, \
151 .eint_type = EINT_TYPE_WKUP, \
152 .eint_func = 3, \
153 .eint_mask = emask, \
154 .eint_offset = eoffs, \
155 .name = id \
156 }
157
158 #define PIN_BANK_4BIT2_ALIVE(pins, reg, id) \
159 { \
160 .type = &bank_type_4bit2_alive,\
161 .pctl_offset = reg, \
162 .nr_pins = pins, \
163 .eint_type = EINT_TYPE_NONE, \
164 .name = id \
165 }
166
167 #define PIN_BANK_2BIT(pins, reg, id) \
168 { \
169 .type = &bank_type_2bit_off, \
170 .pctl_offset = reg, \
171 .nr_pins = pins, \
172 .eint_type = EINT_TYPE_NONE, \
173 .name = id \
174 }
175
176 #define PIN_BANK_2BIT_EINTG(pins, reg, id, eoffs, emask) \
177 { \
178 .type = &bank_type_2bit_off, \
179 .pctl_offset = reg, \
180 .nr_pins = pins, \
181 .eint_type = EINT_TYPE_GPIO, \
182 .eint_func = 3, \
183 .eint_mask = emask, \
184 .eint_offset = eoffs, \
185 .name = id \
186 }
187
188 #define PIN_BANK_2BIT_EINTW(pins, reg, id, eoffs) \
189 { \
190 .type = &bank_type_2bit_alive,\
191 .pctl_offset = reg, \
192 .nr_pins = pins, \
193 .eint_type = EINT_TYPE_WKUP, \
194 .eint_func = 2, \
195 .eint_mask = (1 << (pins)) - 1, \
196 .eint_offset = eoffs, \
197 .name = id \
198 }
199
200 /**
201 * struct s3c64xx_eint0_data: EINT0 common data
202 * @drvdata: pin controller driver data
203 * @domains: IRQ domains of particular EINT0 interrupts
204 * @pins: pin offsets inside of banks of particular EINT0 interrupts
205 */
206 struct s3c64xx_eint0_data {
207 struct samsung_pinctrl_drv_data *drvdata;
208 struct irq_domain *domains[NUM_EINT0];
209 u8 pins[NUM_EINT0];
210 };
211
212 /**
213 * struct s3c64xx_eint0_domain_data: EINT0 per-domain data
214 * @bank: pin bank related to the domain
215 * @eints: EINT0 interrupts related to the domain
216 */
217 struct s3c64xx_eint0_domain_data {
218 struct samsung_pin_bank *bank;
219 u8 eints[];
220 };
221
222 /**
223 * struct s3c64xx_eint_gpio_data: GPIO EINT data
224 * @drvdata: pin controller driver data
225 * @domains: array of domains related to EINT interrupt groups
226 */
227 struct s3c64xx_eint_gpio_data {
228 struct samsung_pinctrl_drv_data *drvdata;
229 struct irq_domain *domains[];
230 };
231
232 /*
233 * Common functions for S3C64xx EINT configuration
234 */
235
236 static int s3c64xx_irq_get_trigger(unsigned int type)
237 {
238 int trigger;
239
240 switch (type) {
241 case IRQ_TYPE_EDGE_RISING:
242 trigger = EINT_EDGE_RISING;
243 break;
244 case IRQ_TYPE_EDGE_FALLING:
245 trigger = EINT_EDGE_FALLING;
246 break;
247 case IRQ_TYPE_EDGE_BOTH:
248 trigger = EINT_EDGE_BOTH;
249 break;
250 case IRQ_TYPE_LEVEL_HIGH:
251 trigger = EINT_LEVEL_HIGH;
252 break;
253 case IRQ_TYPE_LEVEL_LOW:
254 trigger = EINT_LEVEL_LOW;
255 break;
256 default:
257 return -EINVAL;
258 }
259
260 return trigger;
261 }
262
263 static void s3c64xx_irq_set_handler(unsigned int irq, unsigned int type)
264 {
265 /* Edge- and level-triggered interrupts need different handlers */
266 if (type & IRQ_TYPE_EDGE_BOTH)
267 __irq_set_handler_locked(irq, handle_edge_irq);
268 else
269 __irq_set_handler_locked(irq, handle_level_irq);
270 }
271
272 static void s3c64xx_irq_set_function(struct samsung_pinctrl_drv_data *d,
273 struct samsung_pin_bank *bank, int pin)
274 {
275 struct samsung_pin_bank_type *bank_type = bank->type;
276 unsigned long flags;
277 void __iomem *reg;
278 u8 shift;
279 u32 mask;
280 u32 val;
281
282 /* Make sure that pin is configured as interrupt */
283 reg = d->virt_base + bank->pctl_offset;
284 shift = pin;
285 if (bank_type->fld_width[PINCFG_TYPE_FUNC] * shift >= 32) {
286 /* 4-bit bank type with 2 con regs */
287 reg += 4;
288 shift -= 8;
289 }
290
291 shift = shift * bank_type->fld_width[PINCFG_TYPE_FUNC];
292 mask = (1 << bank_type->fld_width[PINCFG_TYPE_FUNC]) - 1;
293
294 spin_lock_irqsave(&bank->slock, flags);
295
296 val = readl(reg);
297 val &= ~(mask << shift);
298 val |= bank->eint_func << shift;
299 writel(val, reg);
300
301 spin_unlock_irqrestore(&bank->slock, flags);
302 }
303
304 /*
305 * Functions for EINT GPIO configuration (EINT groups 1-9)
306 */
307
308 static inline void s3c64xx_gpio_irq_set_mask(struct irq_data *irqd, bool mask)
309 {
310 struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd);
311 struct samsung_pinctrl_drv_data *d = bank->drvdata;
312 unsigned char index = EINT_OFFS(bank->eint_offset) + irqd->hwirq;
313 void __iomem *reg = d->virt_base + EINTMASK_REG(bank->eint_offset);
314 u32 val;
315
316 val = readl(reg);
317 if (mask)
318 val |= 1 << index;
319 else
320 val &= ~(1 << index);
321 writel(val, reg);
322 }
323
324 static void s3c64xx_gpio_irq_unmask(struct irq_data *irqd)
325 {
326 s3c64xx_gpio_irq_set_mask(irqd, false);
327 }
328
329 static void s3c64xx_gpio_irq_mask(struct irq_data *irqd)
330 {
331 s3c64xx_gpio_irq_set_mask(irqd, true);
332 }
333
334 static void s3c64xx_gpio_irq_ack(struct irq_data *irqd)
335 {
336 struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd);
337 struct samsung_pinctrl_drv_data *d = bank->drvdata;
338 unsigned char index = EINT_OFFS(bank->eint_offset) + irqd->hwirq;
339 void __iomem *reg = d->virt_base + EINTPEND_REG(bank->eint_offset);
340
341 writel(1 << index, reg);
342 }
343
344 static int s3c64xx_gpio_irq_set_type(struct irq_data *irqd, unsigned int type)
345 {
346 struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd);
347 struct samsung_pinctrl_drv_data *d = bank->drvdata;
348 void __iomem *reg;
349 int trigger;
350 u8 shift;
351 u32 val;
352
353 trigger = s3c64xx_irq_get_trigger(type);
354 if (trigger < 0) {
355 pr_err("unsupported external interrupt type\n");
356 return -EINVAL;
357 }
358
359 s3c64xx_irq_set_handler(irqd->irq, type);
360
361 /* Set up interrupt trigger */
362 reg = d->virt_base + EINTCON_REG(bank->eint_offset);
363 shift = EINT_OFFS(bank->eint_offset) + irqd->hwirq;
364 shift = 4 * (shift / 4); /* 4 EINTs per trigger selector */
365
366 val = readl(reg);
367 val &= ~(EINT_CON_MASK << shift);
368 val |= trigger << shift;
369 writel(val, reg);
370
371 s3c64xx_irq_set_function(d, bank, irqd->hwirq);
372
373 return 0;
374 }
375
376 /*
377 * irq_chip for gpio interrupts.
378 */
379 static struct irq_chip s3c64xx_gpio_irq_chip = {
380 .name = "GPIO",
381 .irq_unmask = s3c64xx_gpio_irq_unmask,
382 .irq_mask = s3c64xx_gpio_irq_mask,
383 .irq_ack = s3c64xx_gpio_irq_ack,
384 .irq_set_type = s3c64xx_gpio_irq_set_type,
385 };
386
387 static int s3c64xx_gpio_irq_map(struct irq_domain *h, unsigned int virq,
388 irq_hw_number_t hw)
389 {
390 struct samsung_pin_bank *bank = h->host_data;
391
392 if (!(bank->eint_mask & (1 << hw)))
393 return -EINVAL;
394
395 irq_set_chip_and_handler(virq,
396 &s3c64xx_gpio_irq_chip, handle_level_irq);
397 irq_set_chip_data(virq, bank);
398 set_irq_flags(virq, IRQF_VALID);
399
400 return 0;
401 }
402
403 /*
404 * irq domain callbacks for external gpio interrupt controller.
405 */
406 static const struct irq_domain_ops s3c64xx_gpio_irqd_ops = {
407 .map = s3c64xx_gpio_irq_map,
408 .xlate = irq_domain_xlate_twocell,
409 };
410
411 static void s3c64xx_eint_gpio_irq(unsigned int irq, struct irq_desc *desc)
412 {
413 struct irq_chip *chip = irq_get_chip(irq);
414 struct s3c64xx_eint_gpio_data *data = irq_get_handler_data(irq);
415 struct samsung_pinctrl_drv_data *drvdata = data->drvdata;
416
417 chained_irq_enter(chip, desc);
418
419 do {
420 unsigned int svc;
421 unsigned int group;
422 unsigned int pin;
423 unsigned int virq;
424
425 svc = readl(drvdata->virt_base + SERVICE_REG);
426 group = SVC_GROUP(svc);
427 pin = svc & SVC_NUM_MASK;
428
429 if (!group)
430 break;
431
432 /* Group 1 is used for two pin banks */
433 if (group == 1) {
434 if (pin < 8)
435 group = 0;
436 else
437 pin -= 8;
438 }
439
440 virq = irq_linear_revmap(data->domains[group], pin);
441 /*
442 * Something must be really wrong if an unmapped EINT
443 * was unmasked...
444 */
445 BUG_ON(!virq);
446
447 generic_handle_irq(virq);
448 } while (1);
449
450 chained_irq_exit(chip, desc);
451 }
452
453 /**
454 * s3c64xx_eint_gpio_init() - setup handling of external gpio interrupts.
455 * @d: driver data of samsung pinctrl driver.
456 */
457 static int s3c64xx_eint_gpio_init(struct samsung_pinctrl_drv_data *d)
458 {
459 struct s3c64xx_eint_gpio_data *data;
460 struct samsung_pin_bank *bank;
461 struct device *dev = d->dev;
462 unsigned int nr_domains;
463 unsigned int i;
464
465 if (!d->irq) {
466 dev_err(dev, "irq number not available\n");
467 return -EINVAL;
468 }
469
470 nr_domains = 0;
471 bank = d->ctrl->pin_banks;
472 for (i = 0; i < d->ctrl->nr_banks; ++i, ++bank) {
473 unsigned int nr_eints;
474 unsigned int mask;
475
476 if (bank->eint_type != EINT_TYPE_GPIO)
477 continue;
478
479 mask = bank->eint_mask;
480 nr_eints = fls(mask);
481
482 bank->irq_domain = irq_domain_add_linear(bank->of_node,
483 nr_eints, &s3c64xx_gpio_irqd_ops, bank);
484 if (!bank->irq_domain) {
485 dev_err(dev, "gpio irq domain add failed\n");
486 return -ENXIO;
487 }
488
489 ++nr_domains;
490 }
491
492 data = devm_kzalloc(dev, sizeof(*data)
493 + nr_domains * sizeof(*data->domains), GFP_KERNEL);
494 if (!data) {
495 dev_err(dev, "failed to allocate handler data\n");
496 return -ENOMEM;
497 }
498 data->drvdata = d;
499
500 bank = d->ctrl->pin_banks;
501 nr_domains = 0;
502 for (i = 0; i < d->ctrl->nr_banks; ++i, ++bank) {
503 if (bank->eint_type != EINT_TYPE_GPIO)
504 continue;
505
506 data->domains[nr_domains++] = bank->irq_domain;
507 }
508
509 irq_set_chained_handler(d->irq, s3c64xx_eint_gpio_irq);
510 irq_set_handler_data(d->irq, data);
511
512 return 0;
513 }
514
515 /*
516 * Functions for configuration of EINT0 wake-up interrupts
517 */
518
519 static inline void s3c64xx_eint0_irq_set_mask(struct irq_data *irqd, bool mask)
520 {
521 struct s3c64xx_eint0_domain_data *ddata =
522 irq_data_get_irq_chip_data(irqd);
523 struct samsung_pinctrl_drv_data *d = ddata->bank->drvdata;
524 u32 val;
525
526 val = readl(d->virt_base + EINT0MASK_REG);
527 if (mask)
528 val |= 1 << ddata->eints[irqd->hwirq];
529 else
530 val &= ~(1 << ddata->eints[irqd->hwirq]);
531 writel(val, d->virt_base + EINT0MASK_REG);
532 }
533
534 static void s3c64xx_eint0_irq_unmask(struct irq_data *irqd)
535 {
536 s3c64xx_eint0_irq_set_mask(irqd, false);
537 }
538
539 static void s3c64xx_eint0_irq_mask(struct irq_data *irqd)
540 {
541 s3c64xx_eint0_irq_set_mask(irqd, true);
542 }
543
544 static void s3c64xx_eint0_irq_ack(struct irq_data *irqd)
545 {
546 struct s3c64xx_eint0_domain_data *ddata =
547 irq_data_get_irq_chip_data(irqd);
548 struct samsung_pinctrl_drv_data *d = ddata->bank->drvdata;
549
550 writel(1 << ddata->eints[irqd->hwirq],
551 d->virt_base + EINT0PEND_REG);
552 }
553
554 static int s3c64xx_eint0_irq_set_type(struct irq_data *irqd, unsigned int type)
555 {
556 struct s3c64xx_eint0_domain_data *ddata =
557 irq_data_get_irq_chip_data(irqd);
558 struct samsung_pin_bank *bank = ddata->bank;
559 struct samsung_pinctrl_drv_data *d = bank->drvdata;
560 void __iomem *reg;
561 int trigger;
562 u8 shift;
563 u32 val;
564
565 trigger = s3c64xx_irq_get_trigger(type);
566 if (trigger < 0) {
567 pr_err("unsupported external interrupt type\n");
568 return -EINVAL;
569 }
570
571 s3c64xx_irq_set_handler(irqd->irq, type);
572
573 /* Set up interrupt trigger */
574 reg = d->virt_base + EINT0CON0_REG;
575 shift = ddata->eints[irqd->hwirq];
576 if (shift >= EINT_MAX_PER_REG) {
577 reg += 4;
578 shift -= EINT_MAX_PER_REG;
579 }
580 shift = EINT_CON_LEN * (shift / 2);
581
582 val = readl(reg);
583 val &= ~(EINT_CON_MASK << shift);
584 val |= trigger << shift;
585 writel(val, reg);
586
587 s3c64xx_irq_set_function(d, bank, irqd->hwirq);
588
589 return 0;
590 }
591
592 /*
593 * irq_chip for wakeup interrupts
594 */
595 static struct irq_chip s3c64xx_eint0_irq_chip = {
596 .name = "EINT0",
597 .irq_unmask = s3c64xx_eint0_irq_unmask,
598 .irq_mask = s3c64xx_eint0_irq_mask,
599 .irq_ack = s3c64xx_eint0_irq_ack,
600 .irq_set_type = s3c64xx_eint0_irq_set_type,
601 };
602
603 static inline void s3c64xx_irq_demux_eint(unsigned int irq,
604 struct irq_desc *desc, u32 range)
605 {
606 struct irq_chip *chip = irq_get_chip(irq);
607 struct s3c64xx_eint0_data *data = irq_get_handler_data(irq);
608 struct samsung_pinctrl_drv_data *drvdata = data->drvdata;
609 unsigned int pend, mask;
610
611 chained_irq_enter(chip, desc);
612
613 pend = readl(drvdata->virt_base + EINT0PEND_REG);
614 mask = readl(drvdata->virt_base + EINT0MASK_REG);
615
616 pend = pend & range & ~mask;
617 pend &= range;
618
619 while (pend) {
620 unsigned int virq;
621
622 irq = fls(pend) - 1;
623 pend &= ~(1 << irq);
624
625 virq = irq_linear_revmap(data->domains[irq], data->pins[irq]);
626 /*
627 * Something must be really wrong if an unmapped EINT
628 * was unmasked...
629 */
630 BUG_ON(!virq);
631
632 generic_handle_irq(virq);
633 }
634
635 chained_irq_exit(chip, desc);
636 }
637
638 static void s3c64xx_demux_eint0_3(unsigned int irq, struct irq_desc *desc)
639 {
640 s3c64xx_irq_demux_eint(irq, desc, 0xf);
641 }
642
643 static void s3c64xx_demux_eint4_11(unsigned int irq, struct irq_desc *desc)
644 {
645 s3c64xx_irq_demux_eint(irq, desc, 0xff0);
646 }
647
648 static void s3c64xx_demux_eint12_19(unsigned int irq, struct irq_desc *desc)
649 {
650 s3c64xx_irq_demux_eint(irq, desc, 0xff000);
651 }
652
653 static void s3c64xx_demux_eint20_27(unsigned int irq, struct irq_desc *desc)
654 {
655 s3c64xx_irq_demux_eint(irq, desc, 0xff00000);
656 }
657
658 static irq_flow_handler_t s3c64xx_eint0_handlers[NUM_EINT0_IRQ] = {
659 s3c64xx_demux_eint0_3,
660 s3c64xx_demux_eint4_11,
661 s3c64xx_demux_eint12_19,
662 s3c64xx_demux_eint20_27,
663 };
664
665 static int s3c64xx_eint0_irq_map(struct irq_domain *h, unsigned int virq,
666 irq_hw_number_t hw)
667 {
668 struct s3c64xx_eint0_domain_data *ddata = h->host_data;
669 struct samsung_pin_bank *bank = ddata->bank;
670
671 if (!(bank->eint_mask & (1 << hw)))
672 return -EINVAL;
673
674 irq_set_chip_and_handler(virq,
675 &s3c64xx_eint0_irq_chip, handle_level_irq);
676 irq_set_chip_data(virq, ddata);
677 set_irq_flags(virq, IRQF_VALID);
678
679 return 0;
680 }
681
682 /*
683 * irq domain callbacks for external wakeup interrupt controller.
684 */
685 static const struct irq_domain_ops s3c64xx_eint0_irqd_ops = {
686 .map = s3c64xx_eint0_irq_map,
687 .xlate = irq_domain_xlate_twocell,
688 };
689
690 /* list of external wakeup controllers supported */
691 static const struct of_device_id s3c64xx_eint0_irq_ids[] = {
692 { .compatible = "samsung,s3c64xx-wakeup-eint", },
693 { }
694 };
695
696 /**
697 * s3c64xx_eint_eint0_init() - setup handling of external wakeup interrupts.
698 * @d: driver data of samsung pinctrl driver.
699 */
700 static int s3c64xx_eint_eint0_init(struct samsung_pinctrl_drv_data *d)
701 {
702 struct device *dev = d->dev;
703 struct device_node *eint0_np = NULL;
704 struct device_node *np;
705 struct samsung_pin_bank *bank;
706 struct s3c64xx_eint0_data *data;
707 unsigned int i;
708
709 for_each_child_of_node(dev->of_node, np) {
710 if (of_match_node(s3c64xx_eint0_irq_ids, np)) {
711 eint0_np = np;
712 break;
713 }
714 }
715 if (!eint0_np)
716 return -ENODEV;
717
718 data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
719 if (!data) {
720 dev_err(dev, "could not allocate memory for wkup eint data\n");
721 return -ENOMEM;
722 }
723 data->drvdata = d;
724
725 for (i = 0; i < NUM_EINT0_IRQ; ++i) {
726 unsigned int irq;
727
728 irq = irq_of_parse_and_map(eint0_np, i);
729 if (!irq) {
730 dev_err(dev, "failed to get wakeup EINT IRQ %d\n", i);
731 return -ENXIO;
732 }
733
734 irq_set_chained_handler(irq, s3c64xx_eint0_handlers[i]);
735 irq_set_handler_data(irq, data);
736 }
737
738 bank = d->ctrl->pin_banks;
739 for (i = 0; i < d->ctrl->nr_banks; ++i, ++bank) {
740 struct s3c64xx_eint0_domain_data *ddata;
741 unsigned int nr_eints;
742 unsigned int mask;
743 unsigned int irq;
744 unsigned int pin;
745
746 if (bank->eint_type != EINT_TYPE_WKUP)
747 continue;
748
749 mask = bank->eint_mask;
750 nr_eints = fls(mask);
751
752 ddata = devm_kzalloc(dev,
753 sizeof(*ddata) + nr_eints, GFP_KERNEL);
754 if (!ddata) {
755 dev_err(dev, "failed to allocate domain data\n");
756 return -ENOMEM;
757 }
758 ddata->bank = bank;
759
760 bank->irq_domain = irq_domain_add_linear(bank->of_node,
761 nr_eints, &s3c64xx_eint0_irqd_ops, ddata);
762 if (!bank->irq_domain) {
763 dev_err(dev, "wkup irq domain add failed\n");
764 return -ENXIO;
765 }
766
767 irq = bank->eint_offset;
768 mask = bank->eint_mask;
769 for (pin = 0; mask; ++pin, mask >>= 1) {
770 if (!(mask & 1))
771 continue;
772 data->domains[irq] = bank->irq_domain;
773 data->pins[irq] = pin;
774 ddata->eints[pin] = irq;
775 ++irq;
776 }
777 }
778
779 return 0;
780 }
781
782 /* pin banks of s3c64xx pin-controller 0 */
783 static struct samsung_pin_bank s3c64xx_pin_banks0[] = {
784 PIN_BANK_4BIT_EINTG(8, 0x000, "gpa", 0),
785 PIN_BANK_4BIT_EINTG(7, 0x020, "gpb", 8),
786 PIN_BANK_4BIT_EINTG(8, 0x040, "gpc", 16),
787 PIN_BANK_4BIT_EINTG(5, 0x060, "gpd", 32),
788 PIN_BANK_4BIT(5, 0x080, "gpe"),
789 PIN_BANK_2BIT_EINTG(16, 0x0a0, "gpf", 48, 0x3fff),
790 PIN_BANK_4BIT_EINTG(7, 0x0c0, "gpg", 64),
791 PIN_BANK_4BIT2_EINTG(10, 0x0e0, "gph", 80),
792 PIN_BANK_2BIT(16, 0x100, "gpi"),
793 PIN_BANK_2BIT(12, 0x120, "gpj"),
794 PIN_BANK_4BIT2_ALIVE(16, 0x800, "gpk"),
795 PIN_BANK_4BIT2_EINTW(15, 0x810, "gpl", 16, 0x7f00),
796 PIN_BANK_4BIT_EINTW(6, 0x820, "gpm", 23, 0x1f),
797 PIN_BANK_2BIT_EINTW(16, 0x830, "gpn", 0),
798 PIN_BANK_2BIT_EINTG(16, 0x140, "gpo", 96, 0xffff),
799 PIN_BANK_2BIT_EINTG(15, 0x160, "gpp", 112, 0x7fff),
800 PIN_BANK_2BIT_EINTG(9, 0x180, "gpq", 128, 0x1ff),
801 };
802
803 /*
804 * Samsung pinctrl driver data for S3C64xx SoC. S3C64xx SoC includes
805 * one gpio/pin-mux/pinconfig controller.
806 */
807 struct samsung_pin_ctrl s3c64xx_pin_ctrl[] = {
808 {
809 /* pin-controller instance 1 data */
810 .pin_banks = s3c64xx_pin_banks0,
811 .nr_banks = ARRAY_SIZE(s3c64xx_pin_banks0),
812 .eint_gpio_init = s3c64xx_eint_gpio_init,
813 .eint_wkup_init = s3c64xx_eint_eint0_init,
814 .label = "S3C64xx-GPIO",
815 },
816 };
Linux with added FPC-III support