1 /* 2 * Broadcom Kona GPIO Driver 3 * 4 * Author: Broadcom Corporation <bcm-kernel-feedback-list@broadcom.com> 5 * Copyright (C) 2012-2014 Broadcom Corporation 6 * 7 * This program is free software; you can redistribute it and/or 8 * modify it under the terms of the GNU General Public License as 9 * published by the Free Software Foundation version 2. 10 * 11 * This program is distributed "as is" WITHOUT ANY WARRANTY of any 12 * kind, whether express or implied; without even the implied warranty 13 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 * GNU General Public License for more details. 15 */ 16 17 #include <linux/bitops.h> 18 #include <linux/err.h> 19 #include <linux/io.h> 20 #include <linux/gpio/driver.h> 21 #include <linux/of_device.h> 22 #include <linux/init.h> 23 #include <linux/irqdomain.h> 24 #include <linux/irqchip/chained_irq.h> 25 26 #define BCM_GPIO_PASSWD 0x00a5a501 27 #define GPIO_PER_BANK 32 28 #define GPIO_MAX_BANK_NUM 8 29 30 #define GPIO_BANK(gpio) ((gpio) >> 5) 31 #define GPIO_BIT(gpio) ((gpio) & (GPIO_PER_BANK - 1)) 32 33 /* There is a GPIO control register for each GPIO */ 34 #define GPIO_CONTROL(gpio) (0x00000100 + ((gpio) << 2)) 35 36 /* The remaining registers are per GPIO bank */ 37 #define GPIO_OUT_STATUS(bank) (0x00000000 + ((bank) << 2)) 38 #define GPIO_IN_STATUS(bank) (0x00000020 + ((bank) << 2)) 39 #define GPIO_OUT_SET(bank) (0x00000040 + ((bank) << 2)) 40 #define GPIO_OUT_CLEAR(bank) (0x00000060 + ((bank) << 2)) 41 #define GPIO_INT_STATUS(bank) (0x00000080 + ((bank) << 2)) 42 #define GPIO_INT_MASK(bank) (0x000000a0 + ((bank) << 2)) 43 #define GPIO_INT_MSKCLR(bank) (0x000000c0 + ((bank) << 2)) 44 #define GPIO_PWD_STATUS(bank) (0x00000500 + ((bank) << 2)) 45 46 #define GPIO_GPPWR_OFFSET 0x00000520 47 48 #define GPIO_GPCTR0_DBR_SHIFT 5 49 #define GPIO_GPCTR0_DBR_MASK 0x000001e0 50 51 #define GPIO_GPCTR0_ITR_SHIFT 3 52 #define GPIO_GPCTR0_ITR_MASK 0x00000018 53 #define GPIO_GPCTR0_ITR_CMD_RISING_EDGE 0x00000001 54 #define GPIO_GPCTR0_ITR_CMD_FALLING_EDGE 0x00000002 55 #define GPIO_GPCTR0_ITR_CMD_BOTH_EDGE 0x00000003 56 57 #define GPIO_GPCTR0_IOTR_MASK 0x00000001 58 #define GPIO_GPCTR0_IOTR_CMD_0UTPUT 0x00000000 59 #define GPIO_GPCTR0_IOTR_CMD_INPUT 0x00000001 60 61 #define GPIO_GPCTR0_DB_ENABLE_MASK 0x00000100 62 63 #define LOCK_CODE 0xffffffff 64 #define UNLOCK_CODE 0x00000000 65 66 struct bcm_kona_gpio { 67 void __iomem *reg_base; 68 int num_bank; 69 raw_spinlock_t lock; 70 struct gpio_chip gpio_chip; 71 struct irq_domain *irq_domain; 72 struct bcm_kona_gpio_bank *banks; 73 struct platform_device *pdev; 74 }; 75 76 struct bcm_kona_gpio_bank { 77 int id; 78 int irq; 79 /* Used in the interrupt handler */ 80 struct bcm_kona_gpio *kona_gpio; 81 }; 82 83 static inline void bcm_kona_gpio_write_lock_regs(void __iomem *reg_base, 84 int bank_id, u32 lockcode) 85 { 86 writel(BCM_GPIO_PASSWD, reg_base + GPIO_GPPWR_OFFSET); 87 writel(lockcode, reg_base + GPIO_PWD_STATUS(bank_id)); 88 } 89 90 static void bcm_kona_gpio_lock_gpio(struct bcm_kona_gpio *kona_gpio, 91 unsigned gpio) 92 { 93 u32 val; 94 unsigned long flags; 95 int bank_id = GPIO_BANK(gpio); 96 97 raw_spin_lock_irqsave(&kona_gpio->lock, flags); 98 99 val = readl(kona_gpio->reg_base + GPIO_PWD_STATUS(bank_id)); 100 val |= BIT(gpio); 101 bcm_kona_gpio_write_lock_regs(kona_gpio->reg_base, bank_id, val); 102 103 raw_spin_unlock_irqrestore(&kona_gpio->lock, flags); 104 } 105 106 static void bcm_kona_gpio_unlock_gpio(struct bcm_kona_gpio *kona_gpio, 107 unsigned gpio) 108 { 109 u32 val; 110 unsigned long flags; 111 int bank_id = GPIO_BANK(gpio); 112 113 raw_spin_lock_irqsave(&kona_gpio->lock, flags); 114 115 val = readl(kona_gpio->reg_base + GPIO_PWD_STATUS(bank_id)); 116 val &= ~BIT(gpio); 117 bcm_kona_gpio_write_lock_regs(kona_gpio->reg_base, bank_id, val); 118 119 raw_spin_unlock_irqrestore(&kona_gpio->lock, flags); 120 } 121 122 static int bcm_kona_gpio_get_dir(struct gpio_chip *chip, unsigned gpio) 123 { 124 struct bcm_kona_gpio *kona_gpio = gpiochip_get_data(chip); 125 void __iomem *reg_base = kona_gpio->reg_base; 126 u32 val; 127 128 val = readl(reg_base + GPIO_CONTROL(gpio)) & GPIO_GPCTR0_IOTR_MASK; 129 return val ? GPIO_LINE_DIRECTION_IN : GPIO_LINE_DIRECTION_OUT; 130 } 131 132 static void bcm_kona_gpio_set(struct gpio_chip *chip, unsigned gpio, int value) 133 { 134 struct bcm_kona_gpio *kona_gpio; 135 void __iomem *reg_base; 136 int bank_id = GPIO_BANK(gpio); 137 int bit = GPIO_BIT(gpio); 138 u32 val, reg_offset; 139 unsigned long flags; 140 141 kona_gpio = gpiochip_get_data(chip); 142 reg_base = kona_gpio->reg_base; 143 raw_spin_lock_irqsave(&kona_gpio->lock, flags); 144 145 /* this function only applies to output pin */ 146 if (bcm_kona_gpio_get_dir(chip, gpio) == GPIO_LINE_DIRECTION_IN) 147 goto out; 148 149 reg_offset = value ? GPIO_OUT_SET(bank_id) : GPIO_OUT_CLEAR(bank_id); 150 151 val = readl(reg_base + reg_offset); 152 val |= BIT(bit); 153 writel(val, reg_base + reg_offset); 154 155 out: 156 raw_spin_unlock_irqrestore(&kona_gpio->lock, flags); 157 } 158 159 static int bcm_kona_gpio_get(struct gpio_chip *chip, unsigned gpio) 160 { 161 struct bcm_kona_gpio *kona_gpio; 162 void __iomem *reg_base; 163 int bank_id = GPIO_BANK(gpio); 164 int bit = GPIO_BIT(gpio); 165 u32 val, reg_offset; 166 unsigned long flags; 167 168 kona_gpio = gpiochip_get_data(chip); 169 reg_base = kona_gpio->reg_base; 170 raw_spin_lock_irqsave(&kona_gpio->lock, flags); 171 172 if (bcm_kona_gpio_get_dir(chip, gpio) == GPIO_LINE_DIRECTION_IN) 173 reg_offset = GPIO_IN_STATUS(bank_id); 174 else 175 reg_offset = GPIO_OUT_STATUS(bank_id); 176 177 /* read the GPIO bank status */ 178 val = readl(reg_base + reg_offset); 179 180 raw_spin_unlock_irqrestore(&kona_gpio->lock, flags); 181 182 /* return the specified bit status */ 183 return !!(val & BIT(bit)); 184 } 185 186 static int bcm_kona_gpio_request(struct gpio_chip *chip, unsigned gpio) 187 { 188 struct bcm_kona_gpio *kona_gpio = gpiochip_get_data(chip); 189 190 bcm_kona_gpio_unlock_gpio(kona_gpio, gpio); 191 return 0; 192 } 193 194 static void bcm_kona_gpio_free(struct gpio_chip *chip, unsigned gpio) 195 { 196 struct bcm_kona_gpio *kona_gpio = gpiochip_get_data(chip); 197 198 bcm_kona_gpio_lock_gpio(kona_gpio, gpio); 199 } 200 201 static int bcm_kona_gpio_direction_input(struct gpio_chip *chip, unsigned gpio) 202 { 203 struct bcm_kona_gpio *kona_gpio; 204 void __iomem *reg_base; 205 u32 val; 206 unsigned long flags; 207 208 kona_gpio = gpiochip_get_data(chip); 209 reg_base = kona_gpio->reg_base; 210 raw_spin_lock_irqsave(&kona_gpio->lock, flags); 211 212 val = readl(reg_base + GPIO_CONTROL(gpio)); 213 val &= ~GPIO_GPCTR0_IOTR_MASK; 214 val |= GPIO_GPCTR0_IOTR_CMD_INPUT; 215 writel(val, reg_base + GPIO_CONTROL(gpio)); 216 217 raw_spin_unlock_irqrestore(&kona_gpio->lock, flags); 218 219 return 0; 220 } 221 222 static int bcm_kona_gpio_direction_output(struct gpio_chip *chip, 223 unsigned gpio, int value) 224 { 225 struct bcm_kona_gpio *kona_gpio; 226 void __iomem *reg_base; 227 int bank_id = GPIO_BANK(gpio); 228 int bit = GPIO_BIT(gpio); 229 u32 val, reg_offset; 230 unsigned long flags; 231 232 kona_gpio = gpiochip_get_data(chip); 233 reg_base = kona_gpio->reg_base; 234 raw_spin_lock_irqsave(&kona_gpio->lock, flags); 235 236 val = readl(reg_base + GPIO_CONTROL(gpio)); 237 val &= ~GPIO_GPCTR0_IOTR_MASK; 238 val |= GPIO_GPCTR0_IOTR_CMD_0UTPUT; 239 writel(val, reg_base + GPIO_CONTROL(gpio)); 240 reg_offset = value ? GPIO_OUT_SET(bank_id) : GPIO_OUT_CLEAR(bank_id); 241 242 val = readl(reg_base + reg_offset); 243 val |= BIT(bit); 244 writel(val, reg_base + reg_offset); 245 246 raw_spin_unlock_irqrestore(&kona_gpio->lock, flags); 247 248 return 0; 249 } 250 251 static int bcm_kona_gpio_to_irq(struct gpio_chip *chip, unsigned gpio) 252 { 253 struct bcm_kona_gpio *kona_gpio; 254 255 kona_gpio = gpiochip_get_data(chip); 256 if (gpio >= kona_gpio->gpio_chip.ngpio) 257 return -ENXIO; 258 return irq_create_mapping(kona_gpio->irq_domain, gpio); 259 } 260 261 static int bcm_kona_gpio_set_debounce(struct gpio_chip *chip, unsigned gpio, 262 unsigned debounce) 263 { 264 struct bcm_kona_gpio *kona_gpio; 265 void __iomem *reg_base; 266 u32 val, res; 267 unsigned long flags; 268 269 kona_gpio = gpiochip_get_data(chip); 270 reg_base = kona_gpio->reg_base; 271 /* debounce must be 1-128ms (or 0) */ 272 if ((debounce > 0 && debounce < 1000) || debounce > 128000) { 273 dev_err(chip->parent, "Debounce value %u not in range\n", 274 debounce); 275 return -EINVAL; 276 } 277 278 /* calculate debounce bit value */ 279 if (debounce != 0) { 280 /* Convert to ms */ 281 debounce /= 1000; 282 /* find the MSB */ 283 res = fls(debounce) - 1; 284 /* Check if MSB-1 is set (round up or down) */ 285 if (res > 0 && (debounce & BIT(res - 1))) 286 res++; 287 } 288 289 /* spin lock for read-modify-write of the GPIO register */ 290 raw_spin_lock_irqsave(&kona_gpio->lock, flags); 291 292 val = readl(reg_base + GPIO_CONTROL(gpio)); 293 val &= ~GPIO_GPCTR0_DBR_MASK; 294 295 if (debounce == 0) { 296 /* disable debounce */ 297 val &= ~GPIO_GPCTR0_DB_ENABLE_MASK; 298 } else { 299 val |= GPIO_GPCTR0_DB_ENABLE_MASK | 300 (res << GPIO_GPCTR0_DBR_SHIFT); 301 } 302 303 writel(val, reg_base + GPIO_CONTROL(gpio)); 304 305 raw_spin_unlock_irqrestore(&kona_gpio->lock, flags); 306 307 return 0; 308 } 309 310 static int bcm_kona_gpio_set_config(struct gpio_chip *chip, unsigned gpio, 311 unsigned long config) 312 { 313 u32 debounce; 314 315 if (pinconf_to_config_param(config) != PIN_CONFIG_INPUT_DEBOUNCE) 316 return -ENOTSUPP; 317 318 debounce = pinconf_to_config_argument(config); 319 return bcm_kona_gpio_set_debounce(chip, gpio, debounce); 320 } 321 322 static const struct gpio_chip template_chip = { 323 .label = "bcm-kona-gpio", 324 .owner = THIS_MODULE, 325 .request = bcm_kona_gpio_request, 326 .free = bcm_kona_gpio_free, 327 .get_direction = bcm_kona_gpio_get_dir, 328 .direction_input = bcm_kona_gpio_direction_input, 329 .get = bcm_kona_gpio_get, 330 .direction_output = bcm_kona_gpio_direction_output, 331 .set = bcm_kona_gpio_set, 332 .set_config = bcm_kona_gpio_set_config, 333 .to_irq = bcm_kona_gpio_to_irq, 334 .base = 0, 335 }; 336 337 static void bcm_kona_gpio_irq_ack(struct irq_data *d) 338 { 339 struct bcm_kona_gpio *kona_gpio; 340 void __iomem *reg_base; 341 unsigned gpio = d->hwirq; 342 int bank_id = GPIO_BANK(gpio); 343 int bit = GPIO_BIT(gpio); 344 u32 val; 345 unsigned long flags; 346 347 kona_gpio = irq_data_get_irq_chip_data(d); 348 reg_base = kona_gpio->reg_base; 349 raw_spin_lock_irqsave(&kona_gpio->lock, flags); 350 351 val = readl(reg_base + GPIO_INT_STATUS(bank_id)); 352 val |= BIT(bit); 353 writel(val, reg_base + GPIO_INT_STATUS(bank_id)); 354 355 raw_spin_unlock_irqrestore(&kona_gpio->lock, flags); 356 } 357 358 static void bcm_kona_gpio_irq_mask(struct irq_data *d) 359 { 360 struct bcm_kona_gpio *kona_gpio; 361 void __iomem *reg_base; 362 unsigned gpio = d->hwirq; 363 int bank_id = GPIO_BANK(gpio); 364 int bit = GPIO_BIT(gpio); 365 u32 val; 366 unsigned long flags; 367 368 kona_gpio = irq_data_get_irq_chip_data(d); 369 reg_base = kona_gpio->reg_base; 370 raw_spin_lock_irqsave(&kona_gpio->lock, flags); 371 372 val = readl(reg_base + GPIO_INT_MASK(bank_id)); 373 val |= BIT(bit); 374 writel(val, reg_base + GPIO_INT_MASK(bank_id)); 375 gpiochip_disable_irq(&kona_gpio->gpio_chip, gpio); 376 377 raw_spin_unlock_irqrestore(&kona_gpio->lock, flags); 378 } 379 380 static void bcm_kona_gpio_irq_unmask(struct irq_data *d) 381 { 382 struct bcm_kona_gpio *kona_gpio; 383 void __iomem *reg_base; 384 unsigned gpio = d->hwirq; 385 int bank_id = GPIO_BANK(gpio); 386 int bit = GPIO_BIT(gpio); 387 u32 val; 388 unsigned long flags; 389 390 kona_gpio = irq_data_get_irq_chip_data(d); 391 reg_base = kona_gpio->reg_base; 392 raw_spin_lock_irqsave(&kona_gpio->lock, flags); 393 394 val = readl(reg_base + GPIO_INT_MSKCLR(bank_id)); 395 val |= BIT(bit); 396 writel(val, reg_base + GPIO_INT_MSKCLR(bank_id)); 397 gpiochip_enable_irq(&kona_gpio->gpio_chip, gpio); 398 399 raw_spin_unlock_irqrestore(&kona_gpio->lock, flags); 400 } 401 402 static int bcm_kona_gpio_irq_set_type(struct irq_data *d, unsigned int type) 403 { 404 struct bcm_kona_gpio *kona_gpio; 405 void __iomem *reg_base; 406 unsigned gpio = d->hwirq; 407 u32 lvl_type; 408 u32 val; 409 unsigned long flags; 410 411 kona_gpio = irq_data_get_irq_chip_data(d); 412 reg_base = kona_gpio->reg_base; 413 switch (type & IRQ_TYPE_SENSE_MASK) { 414 case IRQ_TYPE_EDGE_RISING: 415 lvl_type = GPIO_GPCTR0_ITR_CMD_RISING_EDGE; 416 break; 417 418 case IRQ_TYPE_EDGE_FALLING: 419 lvl_type = GPIO_GPCTR0_ITR_CMD_FALLING_EDGE; 420 break; 421 422 case IRQ_TYPE_EDGE_BOTH: 423 lvl_type = GPIO_GPCTR0_ITR_CMD_BOTH_EDGE; 424 break; 425 426 case IRQ_TYPE_LEVEL_HIGH: 427 case IRQ_TYPE_LEVEL_LOW: 428 /* BCM GPIO doesn't support level triggering */ 429 default: 430 dev_err(kona_gpio->gpio_chip.parent, 431 "Invalid BCM GPIO irq type 0x%x\n", type); 432 return -EINVAL; 433 } 434 435 raw_spin_lock_irqsave(&kona_gpio->lock, flags); 436 437 val = readl(reg_base + GPIO_CONTROL(gpio)); 438 val &= ~GPIO_GPCTR0_ITR_MASK; 439 val |= lvl_type << GPIO_GPCTR0_ITR_SHIFT; 440 writel(val, reg_base + GPIO_CONTROL(gpio)); 441 442 raw_spin_unlock_irqrestore(&kona_gpio->lock, flags); 443 444 return 0; 445 } 446 447 static void bcm_kona_gpio_irq_handler(struct irq_desc *desc) 448 { 449 void __iomem *reg_base; 450 int bit, bank_id; 451 unsigned long sta; 452 struct bcm_kona_gpio_bank *bank = irq_desc_get_handler_data(desc); 453 struct irq_chip *chip = irq_desc_get_chip(desc); 454 455 chained_irq_enter(chip, desc); 456 457 /* 458 * For bank interrupts, we can't use chip_data to store the kona_gpio 459 * pointer, since GIC needs it for its own purposes. Therefore, we get 460 * our pointer from the bank structure. 461 */ 462 reg_base = bank->kona_gpio->reg_base; 463 bank_id = bank->id; 464 465 while ((sta = readl(reg_base + GPIO_INT_STATUS(bank_id)) & 466 (~(readl(reg_base + GPIO_INT_MASK(bank_id)))))) { 467 for_each_set_bit(bit, &sta, 32) { 468 int hwirq = GPIO_PER_BANK * bank_id + bit; 469 int child_irq = 470 irq_find_mapping(bank->kona_gpio->irq_domain, 471 hwirq); 472 /* 473 * Clear interrupt before handler is called so we don't 474 * miss any interrupt occurred during executing them. 475 */ 476 writel(readl(reg_base + GPIO_INT_STATUS(bank_id)) | 477 BIT(bit), reg_base + GPIO_INT_STATUS(bank_id)); 478 /* Invoke interrupt handler */ 479 generic_handle_irq(child_irq); 480 } 481 } 482 483 chained_irq_exit(chip, desc); 484 } 485 486 static int bcm_kona_gpio_irq_reqres(struct irq_data *d) 487 { 488 struct bcm_kona_gpio *kona_gpio = irq_data_get_irq_chip_data(d); 489 490 return gpiochip_reqres_irq(&kona_gpio->gpio_chip, d->hwirq); 491 } 492 493 static void bcm_kona_gpio_irq_relres(struct irq_data *d) 494 { 495 struct bcm_kona_gpio *kona_gpio = irq_data_get_irq_chip_data(d); 496 497 gpiochip_relres_irq(&kona_gpio->gpio_chip, d->hwirq); 498 } 499 500 static struct irq_chip bcm_gpio_irq_chip = { 501 .name = "bcm-kona-gpio", 502 .irq_ack = bcm_kona_gpio_irq_ack, 503 .irq_mask = bcm_kona_gpio_irq_mask, 504 .irq_unmask = bcm_kona_gpio_irq_unmask, 505 .irq_set_type = bcm_kona_gpio_irq_set_type, 506 .irq_request_resources = bcm_kona_gpio_irq_reqres, 507 .irq_release_resources = bcm_kona_gpio_irq_relres, 508 }; 509 510 static struct of_device_id const bcm_kona_gpio_of_match[] = { 511 { .compatible = "brcm,kona-gpio" }, 512 {} 513 }; 514 515 /* 516 * This lock class tells lockdep that GPIO irqs are in a different 517 * category than their parents, so it won't report false recursion. 518 */ 519 static struct lock_class_key gpio_lock_class; 520 static struct lock_class_key gpio_request_class; 521 522 static int bcm_kona_gpio_irq_map(struct irq_domain *d, unsigned int irq, 523 irq_hw_number_t hwirq) 524 { 525 int ret; 526 527 ret = irq_set_chip_data(irq, d->host_data); 528 if (ret < 0) 529 return ret; 530 irq_set_lockdep_class(irq, &gpio_lock_class, &gpio_request_class); 531 irq_set_chip_and_handler(irq, &bcm_gpio_irq_chip, handle_simple_irq); 532 irq_set_noprobe(irq); 533 534 return 0; 535 } 536 537 static void bcm_kona_gpio_irq_unmap(struct irq_domain *d, unsigned int irq) 538 { 539 irq_set_chip_and_handler(irq, NULL, NULL); 540 irq_set_chip_data(irq, NULL); 541 } 542 543 static const struct irq_domain_ops bcm_kona_irq_ops = { 544 .map = bcm_kona_gpio_irq_map, 545 .unmap = bcm_kona_gpio_irq_unmap, 546 .xlate = irq_domain_xlate_twocell, 547 }; 548 549 static void bcm_kona_gpio_reset(struct bcm_kona_gpio *kona_gpio) 550 { 551 void __iomem *reg_base; 552 int i; 553 554 reg_base = kona_gpio->reg_base; 555 /* disable interrupts and clear status */ 556 for (i = 0; i < kona_gpio->num_bank; i++) { 557 /* Unlock the entire bank first */ 558 bcm_kona_gpio_write_lock_regs(reg_base, i, UNLOCK_CODE); 559 writel(0xffffffff, reg_base + GPIO_INT_MASK(i)); 560 writel(0xffffffff, reg_base + GPIO_INT_STATUS(i)); 561 /* Now re-lock the bank */ 562 bcm_kona_gpio_write_lock_regs(reg_base, i, LOCK_CODE); 563 } 564 } 565 566 static int bcm_kona_gpio_probe(struct platform_device *pdev) 567 { 568 struct device *dev = &pdev->dev; 569 const struct of_device_id *match; 570 struct bcm_kona_gpio_bank *bank; 571 struct bcm_kona_gpio *kona_gpio; 572 struct gpio_chip *chip; 573 int ret; 574 int i; 575 576 match = of_match_device(bcm_kona_gpio_of_match, dev); 577 if (!match) { 578 dev_err(dev, "Failed to find gpio controller\n"); 579 return -ENODEV; 580 } 581 582 kona_gpio = devm_kzalloc(dev, sizeof(*kona_gpio), GFP_KERNEL); 583 if (!kona_gpio) 584 return -ENOMEM; 585 586 kona_gpio->gpio_chip = template_chip; 587 chip = &kona_gpio->gpio_chip; 588 ret = platform_irq_count(pdev); 589 if (!ret) { 590 dev_err(dev, "Couldn't determine # GPIO banks\n"); 591 return -ENOENT; 592 } else if (ret < 0) { 593 return dev_err_probe(dev, ret, "Couldn't determine GPIO banks\n"); 594 } 595 kona_gpio->num_bank = ret; 596 597 if (kona_gpio->num_bank > GPIO_MAX_BANK_NUM) { 598 dev_err(dev, "Too many GPIO banks configured (max=%d)\n", 599 GPIO_MAX_BANK_NUM); 600 return -ENXIO; 601 } 602 kona_gpio->banks = devm_kcalloc(dev, 603 kona_gpio->num_bank, 604 sizeof(*kona_gpio->banks), 605 GFP_KERNEL); 606 if (!kona_gpio->banks) 607 return -ENOMEM; 608 609 kona_gpio->pdev = pdev; 610 platform_set_drvdata(pdev, kona_gpio); 611 chip->of_node = dev->of_node; 612 chip->ngpio = kona_gpio->num_bank * GPIO_PER_BANK; 613 614 kona_gpio->irq_domain = irq_domain_add_linear(dev->of_node, 615 chip->ngpio, 616 &bcm_kona_irq_ops, 617 kona_gpio); 618 if (!kona_gpio->irq_domain) { 619 dev_err(dev, "Couldn't allocate IRQ domain\n"); 620 return -ENXIO; 621 } 622 623 kona_gpio->reg_base = devm_platform_ioremap_resource(pdev, 0); 624 if (IS_ERR(kona_gpio->reg_base)) { 625 ret = PTR_ERR(kona_gpio->reg_base); 626 goto err_irq_domain; 627 } 628 629 for (i = 0; i < kona_gpio->num_bank; i++) { 630 bank = &kona_gpio->banks[i]; 631 bank->id = i; 632 bank->irq = platform_get_irq(pdev, i); 633 bank->kona_gpio = kona_gpio; 634 if (bank->irq < 0) { 635 dev_err(dev, "Couldn't get IRQ for bank %d", i); 636 ret = -ENOENT; 637 goto err_irq_domain; 638 } 639 } 640 641 dev_info(&pdev->dev, "Setting up Kona GPIO\n"); 642 643 bcm_kona_gpio_reset(kona_gpio); 644 645 ret = devm_gpiochip_add_data(dev, chip, kona_gpio); 646 if (ret < 0) { 647 dev_err(dev, "Couldn't add GPIO chip -- %d\n", ret); 648 goto err_irq_domain; 649 } 650 for (i = 0; i < kona_gpio->num_bank; i++) { 651 bank = &kona_gpio->banks[i]; 652 irq_set_chained_handler_and_data(bank->irq, 653 bcm_kona_gpio_irq_handler, 654 bank); 655 } 656 657 raw_spin_lock_init(&kona_gpio->lock); 658 659 return 0; 660 661 err_irq_domain: 662 irq_domain_remove(kona_gpio->irq_domain); 663 664 return ret; 665 } 666 667 static struct platform_driver bcm_kona_gpio_driver = { 668 .driver = { 669 .name = "bcm-kona-gpio", 670 .of_match_table = bcm_kona_gpio_of_match, 671 }, 672 .probe = bcm_kona_gpio_probe, 673 }; 674 builtin_platform_driver(bcm_kona_gpio_driver); 675