Linux 3.11-rc3
[cris-mirror.git] / drivers / pinctrl / pinctrl-s3c64xx.c
blob89143c90300064f2e98d37d29d08164aa4a42b9b
1 /*
2 * S3C64xx specific support for pinctrl-samsung driver.
4 * Copyright (c) 2013 Tomasz Figa <tomasz.figa@gmail.com>
6 * Based on pinctrl-exynos.c, please see the file for original copyrights.
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 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.
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>
29 #include "pinctrl-samsung.h"
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
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)
43 #define EINT12CON_REG 0x200
44 #define EINT12MASK_REG 0x240
45 #define EINT12PEND_REG 0x260
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))
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)))
55 #define SERVICE_REG 0x284
56 #define SERVICEPEND_REG 0x288
58 #define EINT0CON0_REG 0x900
59 #define EINT0MASK_REG 0x920
60 #define EINT0PEND_REG 0x924
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
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, },
76 static struct samsung_pin_bank_type bank_type_4bit_alive = {
77 .fld_width = { 4, 1, 2, },
78 .reg_offset = { 0x00, 0x04, 0x08, },
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, },
86 static struct samsung_pin_bank_type bank_type_4bit2_alive = {
87 .fld_width = { 4, 1, 2, },
88 .reg_offset = { 0x00, 0x08, 0x0c, },
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, },
96 static struct samsung_pin_bank_type bank_type_2bit_alive = {
97 .fld_width = { 2, 1, 2, },
98 .reg_offset = { 0x00, 0x04, 0x08, },
101 #define PIN_BANK_4BIT(pins, reg, id) \
103 .type = &bank_type_4bit_off, \
104 .pctl_offset = reg, \
105 .nr_pins = pins, \
106 .eint_type = EINT_TYPE_NONE, \
107 .name = id \
110 #define PIN_BANK_4BIT_EINTG(pins, reg, id, eoffs) \
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 \
122 #define PIN_BANK_4BIT_EINTW(pins, reg, id, eoffs, emask) \
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 \
134 #define PIN_BANK_4BIT2_EINTG(pins, reg, id, eoffs) \
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 \
146 #define PIN_BANK_4BIT2_EINTW(pins, reg, id, eoffs, emask) \
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 \
158 #define PIN_BANK_4BIT2_ALIVE(pins, reg, id) \
160 .type = &bank_type_4bit2_alive,\
161 .pctl_offset = reg, \
162 .nr_pins = pins, \
163 .eint_type = EINT_TYPE_NONE, \
164 .name = id \
167 #define PIN_BANK_2BIT(pins, reg, id) \
169 .type = &bank_type_2bit_off, \
170 .pctl_offset = reg, \
171 .nr_pins = pins, \
172 .eint_type = EINT_TYPE_NONE, \
173 .name = id \
176 #define PIN_BANK_2BIT_EINTG(pins, reg, id, eoffs, emask) \
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 \
188 #define PIN_BANK_2BIT_EINTW(pins, reg, id, eoffs) \
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 \
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
206 struct s3c64xx_eint0_data {
207 struct samsung_pinctrl_drv_data *drvdata;
208 struct irq_domain *domains[NUM_EINT0];
209 u8 pins[NUM_EINT0];
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
217 struct s3c64xx_eint0_domain_data {
218 struct samsung_pin_bank *bank;
219 u8 eints[];
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
227 struct s3c64xx_eint_gpio_data {
228 struct samsung_pinctrl_drv_data *drvdata;
229 struct irq_domain *domains[];
233 * Common functions for S3C64xx EINT configuration
236 static int s3c64xx_irq_get_trigger(unsigned int type)
238 int trigger;
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;
260 return trigger;
263 static void s3c64xx_irq_set_handler(unsigned int irq, unsigned int type)
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);
272 static void s3c64xx_irq_set_function(struct samsung_pinctrl_drv_data *d,
273 struct samsung_pin_bank *bank, int pin)
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;
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;
291 shift = shift * bank_type->fld_width[PINCFG_TYPE_FUNC];
292 mask = (1 << bank_type->fld_width[PINCFG_TYPE_FUNC]) - 1;
294 spin_lock_irqsave(&bank->slock, flags);
296 val = readl(reg);
297 val &= ~(mask << shift);
298 val |= bank->eint_func << shift;
299 writel(val, reg);
301 spin_unlock_irqrestore(&bank->slock, flags);
305 * Functions for EINT GPIO configuration (EINT groups 1-9)
308 static inline void s3c64xx_gpio_irq_set_mask(struct irq_data *irqd, bool mask)
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;
316 val = readl(reg);
317 if (mask)
318 val |= 1 << index;
319 else
320 val &= ~(1 << index);
321 writel(val, reg);
324 static void s3c64xx_gpio_irq_unmask(struct irq_data *irqd)
326 s3c64xx_gpio_irq_set_mask(irqd, false);
329 static void s3c64xx_gpio_irq_mask(struct irq_data *irqd)
331 s3c64xx_gpio_irq_set_mask(irqd, true);
334 static void s3c64xx_gpio_irq_ack(struct irq_data *irqd)
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);
341 writel(1 << index, reg);
344 static int s3c64xx_gpio_irq_set_type(struct irq_data *irqd, unsigned int type)
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;
353 trigger = s3c64xx_irq_get_trigger(type);
354 if (trigger < 0) {
355 pr_err("unsupported external interrupt type\n");
356 return -EINVAL;
359 s3c64xx_irq_set_handler(irqd->irq, type);
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 */
366 val = readl(reg);
367 val &= ~(EINT_CON_MASK << shift);
368 val |= trigger << shift;
369 writel(val, reg);
371 s3c64xx_irq_set_function(d, bank, irqd->hwirq);
373 return 0;
377 * irq_chip for gpio interrupts.
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,
387 static int s3c64xx_gpio_irq_map(struct irq_domain *h, unsigned int virq,
388 irq_hw_number_t hw)
390 struct samsung_pin_bank *bank = h->host_data;
392 if (!(bank->eint_mask & (1 << hw)))
393 return -EINVAL;
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);
400 return 0;
404 * irq domain callbacks for external gpio interrupt controller.
406 static const struct irq_domain_ops s3c64xx_gpio_irqd_ops = {
407 .map = s3c64xx_gpio_irq_map,
408 .xlate = irq_domain_xlate_twocell,
411 static void s3c64xx_eint_gpio_irq(unsigned int irq, struct irq_desc *desc)
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;
417 chained_irq_enter(chip, desc);
419 do {
420 unsigned int svc;
421 unsigned int group;
422 unsigned int pin;
423 unsigned int virq;
425 svc = readl(drvdata->virt_base + SERVICE_REG);
426 group = SVC_GROUP(svc);
427 pin = svc & SVC_NUM_MASK;
429 if (!group)
430 break;
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;
440 virq = irq_linear_revmap(data->domains[group], pin);
442 * Something must be really wrong if an unmapped EINT
443 * was unmasked...
445 BUG_ON(!virq);
447 generic_handle_irq(virq);
448 } while (1);
450 chained_irq_exit(chip, desc);
454 * s3c64xx_eint_gpio_init() - setup handling of external gpio interrupts.
455 * @d: driver data of samsung pinctrl driver.
457 static int s3c64xx_eint_gpio_init(struct samsung_pinctrl_drv_data *d)
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;
465 if (!d->irq) {
466 dev_err(dev, "irq number not available\n");
467 return -EINVAL;
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;
476 if (bank->eint_type != EINT_TYPE_GPIO)
477 continue;
479 mask = bank->eint_mask;
480 nr_eints = fls(mask);
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;
489 ++nr_domains;
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;
498 data->drvdata = d;
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;
506 data->domains[nr_domains++] = bank->irq_domain;
509 irq_set_chained_handler(d->irq, s3c64xx_eint_gpio_irq);
510 irq_set_handler_data(d->irq, data);
512 return 0;
516 * Functions for configuration of EINT0 wake-up interrupts
519 static inline void s3c64xx_eint0_irq_set_mask(struct irq_data *irqd, bool mask)
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;
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);
534 static void s3c64xx_eint0_irq_unmask(struct irq_data *irqd)
536 s3c64xx_eint0_irq_set_mask(irqd, false);
539 static void s3c64xx_eint0_irq_mask(struct irq_data *irqd)
541 s3c64xx_eint0_irq_set_mask(irqd, true);
544 static void s3c64xx_eint0_irq_ack(struct irq_data *irqd)
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;
550 writel(1 << ddata->eints[irqd->hwirq],
551 d->virt_base + EINT0PEND_REG);
554 static int s3c64xx_eint0_irq_set_type(struct irq_data *irqd, unsigned int type)
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;
565 trigger = s3c64xx_irq_get_trigger(type);
566 if (trigger < 0) {
567 pr_err("unsupported external interrupt type\n");
568 return -EINVAL;
571 s3c64xx_irq_set_handler(irqd->irq, type);
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;
580 shift = EINT_CON_LEN * (shift / 2);
582 val = readl(reg);
583 val &= ~(EINT_CON_MASK << shift);
584 val |= trigger << shift;
585 writel(val, reg);
587 s3c64xx_irq_set_function(d, bank, irqd->hwirq);
589 return 0;
593 * irq_chip for wakeup interrupts
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,
603 static inline void s3c64xx_irq_demux_eint(unsigned int irq,
604 struct irq_desc *desc, u32 range)
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;
611 chained_irq_enter(chip, desc);
613 pend = readl(drvdata->virt_base + EINT0PEND_REG);
614 mask = readl(drvdata->virt_base + EINT0MASK_REG);
616 pend = pend & range & ~mask;
617 pend &= range;
619 while (pend) {
620 unsigned int virq;
622 irq = fls(pend) - 1;
623 pend &= ~(1 << irq);
625 virq = irq_linear_revmap(data->domains[irq], data->pins[irq]);
627 * Something must be really wrong if an unmapped EINT
628 * was unmasked...
630 BUG_ON(!virq);
632 generic_handle_irq(virq);
635 chained_irq_exit(chip, desc);
638 static void s3c64xx_demux_eint0_3(unsigned int irq, struct irq_desc *desc)
640 s3c64xx_irq_demux_eint(irq, desc, 0xf);
643 static void s3c64xx_demux_eint4_11(unsigned int irq, struct irq_desc *desc)
645 s3c64xx_irq_demux_eint(irq, desc, 0xff0);
648 static void s3c64xx_demux_eint12_19(unsigned int irq, struct irq_desc *desc)
650 s3c64xx_irq_demux_eint(irq, desc, 0xff000);
653 static void s3c64xx_demux_eint20_27(unsigned int irq, struct irq_desc *desc)
655 s3c64xx_irq_demux_eint(irq, desc, 0xff00000);
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,
665 static int s3c64xx_eint0_irq_map(struct irq_domain *h, unsigned int virq,
666 irq_hw_number_t hw)
668 struct s3c64xx_eint0_domain_data *ddata = h->host_data;
669 struct samsung_pin_bank *bank = ddata->bank;
671 if (!(bank->eint_mask & (1 << hw)))
672 return -EINVAL;
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);
679 return 0;
683 * irq domain callbacks for external wakeup interrupt controller.
685 static const struct irq_domain_ops s3c64xx_eint0_irqd_ops = {
686 .map = s3c64xx_eint0_irq_map,
687 .xlate = irq_domain_xlate_twocell,
690 /* list of external wakeup controllers supported */
691 static const struct of_device_id s3c64xx_eint0_irq_ids[] = {
692 { .compatible = "samsung,s3c64xx-wakeup-eint", },
697 * s3c64xx_eint_eint0_init() - setup handling of external wakeup interrupts.
698 * @d: driver data of samsung pinctrl driver.
700 static int s3c64xx_eint_eint0_init(struct samsung_pinctrl_drv_data *d)
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;
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;
715 if (!eint0_np)
716 return -ENODEV;
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;
723 data->drvdata = d;
725 for (i = 0; i < NUM_EINT0_IRQ; ++i) {
726 unsigned int irq;
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;
734 irq_set_chained_handler(irq, s3c64xx_eint0_handlers[i]);
735 irq_set_handler_data(irq, data);
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;
746 if (bank->eint_type != EINT_TYPE_WKUP)
747 continue;
749 mask = bank->eint_mask;
750 nr_eints = fls(mask);
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;
758 ddata->bank = bank;
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;
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;
779 return 0;
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),
804 * Samsung pinctrl driver data for S3C64xx SoC. S3C64xx SoC includes
805 * one gpio/pin-mux/pinconfig controller.
807 struct samsung_pin_ctrl s3c64xx_pin_ctrl[] = {
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",