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 const 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 const 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 const 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 const 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 const 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 const 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(struct irq_data *d, 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(d, handle_edge_irq); 268 else 269 irq_set_handler_locked(d, 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 const 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 = bank->pctl_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 unsigned char index = EINT_OFFS(bank->eint_offset) + irqd->hwirq; 312 void __iomem *reg = bank->eint_base + EINTMASK_REG(bank->eint_offset); 313 u32 val; 314 315 val = readl(reg); 316 if (mask) 317 val |= 1 << index; 318 else 319 val &= ~(1 << index); 320 writel(val, reg); 321 } 322 323 static void s3c64xx_gpio_irq_unmask(struct irq_data *irqd) 324 { 325 s3c64xx_gpio_irq_set_mask(irqd, false); 326 } 327 328 static void s3c64xx_gpio_irq_mask(struct irq_data *irqd) 329 { 330 s3c64xx_gpio_irq_set_mask(irqd, true); 331 } 332 333 static void s3c64xx_gpio_irq_ack(struct irq_data *irqd) 334 { 335 struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd); 336 unsigned char index = EINT_OFFS(bank->eint_offset) + irqd->hwirq; 337 void __iomem *reg = bank->eint_base + EINTPEND_REG(bank->eint_offset); 338 339 writel(1 << index, reg); 340 } 341 342 static int s3c64xx_gpio_irq_set_type(struct irq_data *irqd, unsigned int type) 343 { 344 struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd); 345 struct samsung_pinctrl_drv_data *d = bank->drvdata; 346 void __iomem *reg; 347 int trigger; 348 u8 shift; 349 u32 val; 350 351 trigger = s3c64xx_irq_get_trigger(type); 352 if (trigger < 0) { 353 pr_err("unsupported external interrupt type\n"); 354 return -EINVAL; 355 } 356 357 s3c64xx_irq_set_handler(irqd, type); 358 359 /* Set up interrupt trigger */ 360 reg = bank->eint_base + EINTCON_REG(bank->eint_offset); 361 shift = EINT_OFFS(bank->eint_offset) + irqd->hwirq; 362 shift = 4 * (shift / 4); /* 4 EINTs per trigger selector */ 363 364 val = readl(reg); 365 val &= ~(EINT_CON_MASK << shift); 366 val |= trigger << shift; 367 writel(val, reg); 368 369 s3c64xx_irq_set_function(d, bank, irqd->hwirq); 370 371 return 0; 372 } 373 374 /* 375 * irq_chip for gpio interrupts. 376 */ 377 static struct irq_chip s3c64xx_gpio_irq_chip = { 378 .name = "GPIO", 379 .irq_unmask = s3c64xx_gpio_irq_unmask, 380 .irq_mask = s3c64xx_gpio_irq_mask, 381 .irq_ack = s3c64xx_gpio_irq_ack, 382 .irq_set_type = s3c64xx_gpio_irq_set_type, 383 }; 384 385 static int s3c64xx_gpio_irq_map(struct irq_domain *h, unsigned int virq, 386 irq_hw_number_t hw) 387 { 388 struct samsung_pin_bank *bank = h->host_data; 389 390 if (!(bank->eint_mask & (1 << hw))) 391 return -EINVAL; 392 393 irq_set_chip_and_handler(virq, 394 &s3c64xx_gpio_irq_chip, handle_level_irq); 395 irq_set_chip_data(virq, bank); 396 397 return 0; 398 } 399 400 /* 401 * irq domain callbacks for external gpio interrupt controller. 402 */ 403 static const struct irq_domain_ops s3c64xx_gpio_irqd_ops = { 404 .map = s3c64xx_gpio_irq_map, 405 .xlate = irq_domain_xlate_twocell, 406 }; 407 408 static void s3c64xx_eint_gpio_irq(struct irq_desc *desc) 409 { 410 struct irq_chip *chip = irq_desc_get_chip(desc); 411 struct s3c64xx_eint_gpio_data *data = irq_desc_get_handler_data(desc); 412 struct irq_data *irqd = irq_desc_get_irq_data(desc); 413 struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd); 414 415 chained_irq_enter(chip, desc); 416 417 do { 418 unsigned int svc; 419 unsigned int group; 420 unsigned int pin; 421 unsigned int virq; 422 423 svc = readl(bank->eint_base + SERVICE_REG); 424 group = SVC_GROUP(svc); 425 pin = svc & SVC_NUM_MASK; 426 427 if (!group) 428 break; 429 430 /* Group 1 is used for two pin banks */ 431 if (group == 1) { 432 if (pin < 8) 433 group = 0; 434 else 435 pin -= 8; 436 } 437 438 virq = irq_linear_revmap(data->domains[group], pin); 439 /* 440 * Something must be really wrong if an unmapped EINT 441 * was unmasked... 442 */ 443 BUG_ON(!virq); 444 445 generic_handle_irq(virq); 446 } while (1); 447 448 chained_irq_exit(chip, desc); 449 } 450 451 /** 452 * s3c64xx_eint_gpio_init() - setup handling of external gpio interrupts. 453 * @d: driver data of samsung pinctrl driver. 454 */ 455 static int s3c64xx_eint_gpio_init(struct samsung_pinctrl_drv_data *d) 456 { 457 struct s3c64xx_eint_gpio_data *data; 458 struct samsung_pin_bank *bank; 459 struct device *dev = d->dev; 460 unsigned int nr_domains; 461 unsigned int i; 462 463 if (!d->irq) { 464 dev_err(dev, "irq number not available\n"); 465 return -EINVAL; 466 } 467 468 nr_domains = 0; 469 bank = d->pin_banks; 470 for (i = 0; i < d->nr_banks; ++i, ++bank) { 471 unsigned int nr_eints; 472 unsigned int mask; 473 474 if (bank->eint_type != EINT_TYPE_GPIO) 475 continue; 476 477 mask = bank->eint_mask; 478 nr_eints = fls(mask); 479 480 bank->irq_domain = irq_domain_add_linear(bank->of_node, 481 nr_eints, &s3c64xx_gpio_irqd_ops, bank); 482 if (!bank->irq_domain) { 483 dev_err(dev, "gpio irq domain add failed\n"); 484 return -ENXIO; 485 } 486 487 ++nr_domains; 488 } 489 490 data = devm_kzalloc(dev, sizeof(*data) 491 + nr_domains * sizeof(*data->domains), GFP_KERNEL); 492 if (!data) { 493 dev_err(dev, "failed to allocate handler data\n"); 494 return -ENOMEM; 495 } 496 data->drvdata = d; 497 498 bank = d->pin_banks; 499 nr_domains = 0; 500 for (i = 0; i < d->nr_banks; ++i, ++bank) { 501 if (bank->eint_type != EINT_TYPE_GPIO) 502 continue; 503 504 data->domains[nr_domains++] = bank->irq_domain; 505 } 506 507 irq_set_chained_handler_and_data(d->irq, s3c64xx_eint_gpio_irq, data); 508 509 return 0; 510 } 511 512 /* 513 * Functions for configuration of EINT0 wake-up interrupts 514 */ 515 516 static inline void s3c64xx_eint0_irq_set_mask(struct irq_data *irqd, bool mask) 517 { 518 struct s3c64xx_eint0_domain_data *ddata = 519 irq_data_get_irq_chip_data(irqd); 520 struct samsung_pin_bank *bank = ddata->bank; 521 u32 val; 522 523 val = readl(bank->eint_base + EINT0MASK_REG); 524 if (mask) 525 val |= 1 << ddata->eints[irqd->hwirq]; 526 else 527 val &= ~(1 << ddata->eints[irqd->hwirq]); 528 writel(val, bank->eint_base + EINT0MASK_REG); 529 } 530 531 static void s3c64xx_eint0_irq_unmask(struct irq_data *irqd) 532 { 533 s3c64xx_eint0_irq_set_mask(irqd, false); 534 } 535 536 static void s3c64xx_eint0_irq_mask(struct irq_data *irqd) 537 { 538 s3c64xx_eint0_irq_set_mask(irqd, true); 539 } 540 541 static void s3c64xx_eint0_irq_ack(struct irq_data *irqd) 542 { 543 struct s3c64xx_eint0_domain_data *ddata = 544 irq_data_get_irq_chip_data(irqd); 545 struct samsung_pin_bank *bank = ddata->bank; 546 547 writel(1 << ddata->eints[irqd->hwirq], 548 bank->eint_base + EINT0PEND_REG); 549 } 550 551 static int s3c64xx_eint0_irq_set_type(struct irq_data *irqd, unsigned int type) 552 { 553 struct s3c64xx_eint0_domain_data *ddata = 554 irq_data_get_irq_chip_data(irqd); 555 struct samsung_pin_bank *bank = ddata->bank; 556 struct samsung_pinctrl_drv_data *d = ddata->bank->drvdata; 557 void __iomem *reg; 558 int trigger; 559 u8 shift; 560 u32 val; 561 562 trigger = s3c64xx_irq_get_trigger(type); 563 if (trigger < 0) { 564 pr_err("unsupported external interrupt type\n"); 565 return -EINVAL; 566 } 567 568 s3c64xx_irq_set_handler(irqd, type); 569 570 /* Set up interrupt trigger */ 571 reg = bank->eint_base + EINT0CON0_REG; 572 shift = ddata->eints[irqd->hwirq]; 573 if (shift >= EINT_MAX_PER_REG) { 574 reg += 4; 575 shift -= EINT_MAX_PER_REG; 576 } 577 shift = EINT_CON_LEN * (shift / 2); 578 579 val = readl(reg); 580 val &= ~(EINT_CON_MASK << shift); 581 val |= trigger << shift; 582 writel(val, reg); 583 584 s3c64xx_irq_set_function(d, bank, irqd->hwirq); 585 586 return 0; 587 } 588 589 /* 590 * irq_chip for wakeup interrupts 591 */ 592 static struct irq_chip s3c64xx_eint0_irq_chip = { 593 .name = "EINT0", 594 .irq_unmask = s3c64xx_eint0_irq_unmask, 595 .irq_mask = s3c64xx_eint0_irq_mask, 596 .irq_ack = s3c64xx_eint0_irq_ack, 597 .irq_set_type = s3c64xx_eint0_irq_set_type, 598 }; 599 600 static inline void s3c64xx_irq_demux_eint(struct irq_desc *desc, u32 range) 601 { 602 struct irq_chip *chip = irq_desc_get_chip(desc); 603 struct irq_data *irqd = irq_desc_get_irq_data(desc); 604 struct s3c64xx_eint0_domain_data *ddata = 605 irq_data_get_irq_chip_data(irqd); 606 struct samsung_pin_bank *bank = ddata->bank; 607 608 struct s3c64xx_eint0_data *data = irq_desc_get_handler_data(desc); 609 610 unsigned int pend, mask; 611 612 chained_irq_enter(chip, desc); 613 614 pend = readl(bank->eint_base + EINT0PEND_REG); 615 mask = readl(bank->eint_base + EINT0MASK_REG); 616 617 pend = pend & range & ~mask; 618 pend &= range; 619 620 while (pend) { 621 unsigned int virq, irq; 622 623 irq = fls(pend) - 1; 624 pend &= ~(1 << irq); 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(struct irq_desc *desc) 639 { 640 s3c64xx_irq_demux_eint(desc, 0xf); 641 } 642 643 static void s3c64xx_demux_eint4_11(struct irq_desc *desc) 644 { 645 s3c64xx_irq_demux_eint(desc, 0xff0); 646 } 647 648 static void s3c64xx_demux_eint12_19(struct irq_desc *desc) 649 { 650 s3c64xx_irq_demux_eint(desc, 0xff000); 651 } 652 653 static void s3c64xx_demux_eint20_27(struct irq_desc *desc) 654 { 655 s3c64xx_irq_demux_eint(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 678 return 0; 679 } 680 681 /* 682 * irq domain callbacks for external wakeup interrupt controller. 683 */ 684 static const struct irq_domain_ops s3c64xx_eint0_irqd_ops = { 685 .map = s3c64xx_eint0_irq_map, 686 .xlate = irq_domain_xlate_twocell, 687 }; 688 689 /* list of external wakeup controllers supported */ 690 static const struct of_device_id s3c64xx_eint0_irq_ids[] = { 691 { .compatible = "samsung,s3c64xx-wakeup-eint", }, 692 { } 693 }; 694 695 /** 696 * s3c64xx_eint_eint0_init() - setup handling of external wakeup interrupts. 697 * @d: driver data of samsung pinctrl driver. 698 */ 699 static int s3c64xx_eint_eint0_init(struct samsung_pinctrl_drv_data *d) 700 { 701 struct device *dev = d->dev; 702 struct device_node *eint0_np = NULL; 703 struct device_node *np; 704 struct samsung_pin_bank *bank; 705 struct s3c64xx_eint0_data *data; 706 unsigned int i; 707 708 for_each_child_of_node(dev->of_node, np) { 709 if (of_match_node(s3c64xx_eint0_irq_ids, np)) { 710 eint0_np = np; 711 break; 712 } 713 } 714 if (!eint0_np) 715 return -ENODEV; 716 717 data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); 718 if (!data) { 719 dev_err(dev, "could not allocate memory for wkup eint data\n"); 720 return -ENOMEM; 721 } 722 data->drvdata = d; 723 724 for (i = 0; i < NUM_EINT0_IRQ; ++i) { 725 unsigned int irq; 726 727 irq = irq_of_parse_and_map(eint0_np, i); 728 if (!irq) { 729 dev_err(dev, "failed to get wakeup EINT IRQ %d\n", i); 730 return -ENXIO; 731 } 732 733 irq_set_chained_handler_and_data(irq, 734 s3c64xx_eint0_handlers[i], 735 data); 736 } 737 738 bank = d->pin_banks; 739 for (i = 0; i < d->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 const struct samsung_pin_bank_data s3c64xx_pin_banks0[] __initconst = { 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 const struct samsung_pin_ctrl s3c64xx_pin_ctrl[] __initconst = { 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 }, 815 }; 816