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 }; 817