1 /* 2 * Support functions for OMAP GPIO 3 * 4 * Copyright (C) 2003-2005 Nokia Corporation 5 * Written by Juha Yrjölä <juha.yrjola@nokia.com> 6 * 7 * Copyright (C) 2009 Texas Instruments 8 * Added OMAP4 support - Santosh Shilimkar <santosh.shilimkar@ti.com> 9 * 10 * This program is free software; you can redistribute it and/or modify 11 * it under the terms of the GNU General Public License version 2 as 12 * published by the Free Software Foundation. 13 */ 14 15 #include <linux/init.h> 16 #include <linux/module.h> 17 #include <linux/interrupt.h> 18 #include <linux/syscore_ops.h> 19 #include <linux/err.h> 20 #include <linux/clk.h> 21 #include <linux/io.h> 22 #include <linux/device.h> 23 #include <linux/pm_runtime.h> 24 #include <linux/pm.h> 25 #include <linux/of.h> 26 #include <linux/of_device.h> 27 #include <linux/irqchip/chained_irq.h> 28 #include <linux/gpio.h> 29 #include <linux/bitops.h> 30 #include <linux/platform_data/gpio-omap.h> 31 32 #define OFF_MODE 1 33 34 static LIST_HEAD(omap_gpio_list); 35 36 struct gpio_regs { 37 u32 irqenable1; 38 u32 irqenable2; 39 u32 wake_en; 40 u32 ctrl; 41 u32 oe; 42 u32 leveldetect0; 43 u32 leveldetect1; 44 u32 risingdetect; 45 u32 fallingdetect; 46 u32 dataout; 47 u32 debounce; 48 u32 debounce_en; 49 }; 50 51 struct gpio_bank { 52 struct list_head node; 53 void __iomem *base; 54 u16 irq; 55 u32 non_wakeup_gpios; 56 u32 enabled_non_wakeup_gpios; 57 struct gpio_regs context; 58 u32 saved_datain; 59 u32 level_mask; 60 u32 toggle_mask; 61 spinlock_t lock; 62 struct gpio_chip chip; 63 struct clk *dbck; 64 u32 mod_usage; 65 u32 irq_usage; 66 u32 dbck_enable_mask; 67 bool dbck_enabled; 68 struct device *dev; 69 bool is_mpuio; 70 bool dbck_flag; 71 bool loses_context; 72 bool context_valid; 73 int stride; 74 u32 width; 75 int context_loss_count; 76 int power_mode; 77 bool workaround_enabled; 78 79 void (*set_dataout)(struct gpio_bank *bank, int gpio, int enable); 80 int (*get_context_loss_count)(struct device *dev); 81 82 struct omap_gpio_reg_offs *regs; 83 }; 84 85 #define GPIO_INDEX(bank, gpio) (gpio % bank->width) 86 #define GPIO_BIT(bank, gpio) (BIT(GPIO_INDEX(bank, gpio))) 87 #define GPIO_MOD_CTRL_BIT BIT(0) 88 89 #define BANK_USED(bank) (bank->mod_usage || bank->irq_usage) 90 #define LINE_USED(line, offset) (line & (BIT(offset))) 91 92 static int irq_to_gpio(struct gpio_bank *bank, unsigned int gpio_irq) 93 { 94 return bank->chip.base + gpio_irq; 95 } 96 97 static inline struct gpio_bank *_irq_data_get_bank(struct irq_data *d) 98 { 99 struct gpio_chip *chip = irq_data_get_irq_chip_data(d); 100 return container_of(chip, struct gpio_bank, chip); 101 } 102 103 static void _set_gpio_direction(struct gpio_bank *bank, int gpio, int is_input) 104 { 105 void __iomem *reg = bank->base; 106 u32 l; 107 108 reg += bank->regs->direction; 109 l = readl_relaxed(reg); 110 if (is_input) 111 l |= BIT(gpio); 112 else 113 l &= ~(BIT(gpio)); 114 writel_relaxed(l, reg); 115 bank->context.oe = l; 116 } 117 118 119 /* set data out value using dedicate set/clear register */ 120 static void _set_gpio_dataout_reg(struct gpio_bank *bank, int gpio, int enable) 121 { 122 void __iomem *reg = bank->base; 123 u32 l = GPIO_BIT(bank, gpio); 124 125 if (enable) { 126 reg += bank->regs->set_dataout; 127 bank->context.dataout |= l; 128 } else { 129 reg += bank->regs->clr_dataout; 130 bank->context.dataout &= ~l; 131 } 132 133 writel_relaxed(l, reg); 134 } 135 136 /* set data out value using mask register */ 137 static void _set_gpio_dataout_mask(struct gpio_bank *bank, int gpio, int enable) 138 { 139 void __iomem *reg = bank->base + bank->regs->dataout; 140 u32 gpio_bit = GPIO_BIT(bank, gpio); 141 u32 l; 142 143 l = readl_relaxed(reg); 144 if (enable) 145 l |= gpio_bit; 146 else 147 l &= ~gpio_bit; 148 writel_relaxed(l, reg); 149 bank->context.dataout = l; 150 } 151 152 static int _get_gpio_datain(struct gpio_bank *bank, int offset) 153 { 154 void __iomem *reg = bank->base + bank->regs->datain; 155 156 return (readl_relaxed(reg) & (BIT(offset))) != 0; 157 } 158 159 static int _get_gpio_dataout(struct gpio_bank *bank, int offset) 160 { 161 void __iomem *reg = bank->base + bank->regs->dataout; 162 163 return (readl_relaxed(reg) & (BIT(offset))) != 0; 164 } 165 166 static inline void _gpio_rmw(void __iomem *base, u32 reg, u32 mask, bool set) 167 { 168 int l = readl_relaxed(base + reg); 169 170 if (set) 171 l |= mask; 172 else 173 l &= ~mask; 174 175 writel_relaxed(l, base + reg); 176 } 177 178 static inline void _gpio_dbck_enable(struct gpio_bank *bank) 179 { 180 if (bank->dbck_enable_mask && !bank->dbck_enabled) { 181 clk_prepare_enable(bank->dbck); 182 bank->dbck_enabled = true; 183 184 writel_relaxed(bank->dbck_enable_mask, 185 bank->base + bank->regs->debounce_en); 186 } 187 } 188 189 static inline void _gpio_dbck_disable(struct gpio_bank *bank) 190 { 191 if (bank->dbck_enable_mask && bank->dbck_enabled) { 192 /* 193 * Disable debounce before cutting it's clock. If debounce is 194 * enabled but the clock is not, GPIO module seems to be unable 195 * to detect events and generate interrupts at least on OMAP3. 196 */ 197 writel_relaxed(0, bank->base + bank->regs->debounce_en); 198 199 clk_disable_unprepare(bank->dbck); 200 bank->dbck_enabled = false; 201 } 202 } 203 204 /** 205 * _set_gpio_debounce - low level gpio debounce time 206 * @bank: the gpio bank we're acting upon 207 * @gpio: the gpio number on this @gpio 208 * @debounce: debounce time to use 209 * 210 * OMAP's debounce time is in 31us steps so we need 211 * to convert and round up to the closest unit. 212 */ 213 static void _set_gpio_debounce(struct gpio_bank *bank, unsigned gpio, 214 unsigned debounce) 215 { 216 void __iomem *reg; 217 u32 val; 218 u32 l; 219 220 if (!bank->dbck_flag) 221 return; 222 223 if (debounce < 32) 224 debounce = 0x01; 225 else if (debounce > 7936) 226 debounce = 0xff; 227 else 228 debounce = (debounce / 0x1f) - 1; 229 230 l = GPIO_BIT(bank, gpio); 231 232 clk_prepare_enable(bank->dbck); 233 reg = bank->base + bank->regs->debounce; 234 writel_relaxed(debounce, reg); 235 236 reg = bank->base + bank->regs->debounce_en; 237 val = readl_relaxed(reg); 238 239 if (debounce) 240 val |= l; 241 else 242 val &= ~l; 243 bank->dbck_enable_mask = val; 244 245 writel_relaxed(val, reg); 246 clk_disable_unprepare(bank->dbck); 247 /* 248 * Enable debounce clock per module. 249 * This call is mandatory because in omap_gpio_request() when 250 * *_runtime_get_sync() is called, _gpio_dbck_enable() within 251 * runtime callbck fails to turn on dbck because dbck_enable_mask 252 * used within _gpio_dbck_enable() is still not initialized at 253 * that point. Therefore we have to enable dbck here. 254 */ 255 _gpio_dbck_enable(bank); 256 if (bank->dbck_enable_mask) { 257 bank->context.debounce = debounce; 258 bank->context.debounce_en = val; 259 } 260 } 261 262 /** 263 * _clear_gpio_debounce - clear debounce settings for a gpio 264 * @bank: the gpio bank we're acting upon 265 * @gpio: the gpio number on this @gpio 266 * 267 * If a gpio is using debounce, then clear the debounce enable bit and if 268 * this is the only gpio in this bank using debounce, then clear the debounce 269 * time too. The debounce clock will also be disabled when calling this function 270 * if this is the only gpio in the bank using debounce. 271 */ 272 static void _clear_gpio_debounce(struct gpio_bank *bank, unsigned gpio) 273 { 274 u32 gpio_bit = GPIO_BIT(bank, gpio); 275 276 if (!bank->dbck_flag) 277 return; 278 279 if (!(bank->dbck_enable_mask & gpio_bit)) 280 return; 281 282 bank->dbck_enable_mask &= ~gpio_bit; 283 bank->context.debounce_en &= ~gpio_bit; 284 writel_relaxed(bank->context.debounce_en, 285 bank->base + bank->regs->debounce_en); 286 287 if (!bank->dbck_enable_mask) { 288 bank->context.debounce = 0; 289 writel_relaxed(bank->context.debounce, bank->base + 290 bank->regs->debounce); 291 clk_disable_unprepare(bank->dbck); 292 bank->dbck_enabled = false; 293 } 294 } 295 296 static inline void set_gpio_trigger(struct gpio_bank *bank, int gpio, 297 unsigned trigger) 298 { 299 void __iomem *base = bank->base; 300 u32 gpio_bit = BIT(gpio); 301 302 _gpio_rmw(base, bank->regs->leveldetect0, gpio_bit, 303 trigger & IRQ_TYPE_LEVEL_LOW); 304 _gpio_rmw(base, bank->regs->leveldetect1, gpio_bit, 305 trigger & IRQ_TYPE_LEVEL_HIGH); 306 _gpio_rmw(base, bank->regs->risingdetect, gpio_bit, 307 trigger & IRQ_TYPE_EDGE_RISING); 308 _gpio_rmw(base, bank->regs->fallingdetect, gpio_bit, 309 trigger & IRQ_TYPE_EDGE_FALLING); 310 311 bank->context.leveldetect0 = 312 readl_relaxed(bank->base + bank->regs->leveldetect0); 313 bank->context.leveldetect1 = 314 readl_relaxed(bank->base + bank->regs->leveldetect1); 315 bank->context.risingdetect = 316 readl_relaxed(bank->base + bank->regs->risingdetect); 317 bank->context.fallingdetect = 318 readl_relaxed(bank->base + bank->regs->fallingdetect); 319 320 if (likely(!(bank->non_wakeup_gpios & gpio_bit))) { 321 _gpio_rmw(base, bank->regs->wkup_en, gpio_bit, trigger != 0); 322 bank->context.wake_en = 323 readl_relaxed(bank->base + bank->regs->wkup_en); 324 } 325 326 /* This part needs to be executed always for OMAP{34xx, 44xx} */ 327 if (!bank->regs->irqctrl) { 328 /* On omap24xx proceed only when valid GPIO bit is set */ 329 if (bank->non_wakeup_gpios) { 330 if (!(bank->non_wakeup_gpios & gpio_bit)) 331 goto exit; 332 } 333 334 /* 335 * Log the edge gpio and manually trigger the IRQ 336 * after resume if the input level changes 337 * to avoid irq lost during PER RET/OFF mode 338 * Applies for omap2 non-wakeup gpio and all omap3 gpios 339 */ 340 if (trigger & IRQ_TYPE_EDGE_BOTH) 341 bank->enabled_non_wakeup_gpios |= gpio_bit; 342 else 343 bank->enabled_non_wakeup_gpios &= ~gpio_bit; 344 } 345 346 exit: 347 bank->level_mask = 348 readl_relaxed(bank->base + bank->regs->leveldetect0) | 349 readl_relaxed(bank->base + bank->regs->leveldetect1); 350 } 351 352 #ifdef CONFIG_ARCH_OMAP1 353 /* 354 * This only applies to chips that can't do both rising and falling edge 355 * detection at once. For all other chips, this function is a noop. 356 */ 357 static void _toggle_gpio_edge_triggering(struct gpio_bank *bank, int gpio) 358 { 359 void __iomem *reg = bank->base; 360 u32 l = 0; 361 362 if (!bank->regs->irqctrl) 363 return; 364 365 reg += bank->regs->irqctrl; 366 367 l = readl_relaxed(reg); 368 if ((l >> gpio) & 1) 369 l &= ~(BIT(gpio)); 370 else 371 l |= BIT(gpio); 372 373 writel_relaxed(l, reg); 374 } 375 #else 376 static void _toggle_gpio_edge_triggering(struct gpio_bank *bank, int gpio) {} 377 #endif 378 379 static int _set_gpio_triggering(struct gpio_bank *bank, int gpio, 380 unsigned trigger) 381 { 382 void __iomem *reg = bank->base; 383 void __iomem *base = bank->base; 384 u32 l = 0; 385 386 if (bank->regs->leveldetect0 && bank->regs->wkup_en) { 387 set_gpio_trigger(bank, gpio, trigger); 388 } else if (bank->regs->irqctrl) { 389 reg += bank->regs->irqctrl; 390 391 l = readl_relaxed(reg); 392 if ((trigger & IRQ_TYPE_SENSE_MASK) == IRQ_TYPE_EDGE_BOTH) 393 bank->toggle_mask |= BIT(gpio); 394 if (trigger & IRQ_TYPE_EDGE_RISING) 395 l |= BIT(gpio); 396 else if (trigger & IRQ_TYPE_EDGE_FALLING) 397 l &= ~(BIT(gpio)); 398 else 399 return -EINVAL; 400 401 writel_relaxed(l, reg); 402 } else if (bank->regs->edgectrl1) { 403 if (gpio & 0x08) 404 reg += bank->regs->edgectrl2; 405 else 406 reg += bank->regs->edgectrl1; 407 408 gpio &= 0x07; 409 l = readl_relaxed(reg); 410 l &= ~(3 << (gpio << 1)); 411 if (trigger & IRQ_TYPE_EDGE_RISING) 412 l |= 2 << (gpio << 1); 413 if (trigger & IRQ_TYPE_EDGE_FALLING) 414 l |= BIT(gpio << 1); 415 416 /* Enable wake-up during idle for dynamic tick */ 417 _gpio_rmw(base, bank->regs->wkup_en, BIT(gpio), trigger); 418 bank->context.wake_en = 419 readl_relaxed(bank->base + bank->regs->wkup_en); 420 writel_relaxed(l, reg); 421 } 422 return 0; 423 } 424 425 static void _enable_gpio_module(struct gpio_bank *bank, unsigned offset) 426 { 427 if (bank->regs->pinctrl) { 428 void __iomem *reg = bank->base + bank->regs->pinctrl; 429 430 /* Claim the pin for MPU */ 431 writel_relaxed(readl_relaxed(reg) | (BIT(offset)), reg); 432 } 433 434 if (bank->regs->ctrl && !BANK_USED(bank)) { 435 void __iomem *reg = bank->base + bank->regs->ctrl; 436 u32 ctrl; 437 438 ctrl = readl_relaxed(reg); 439 /* Module is enabled, clocks are not gated */ 440 ctrl &= ~GPIO_MOD_CTRL_BIT; 441 writel_relaxed(ctrl, reg); 442 bank->context.ctrl = ctrl; 443 } 444 } 445 446 static void _disable_gpio_module(struct gpio_bank *bank, unsigned offset) 447 { 448 void __iomem *base = bank->base; 449 450 if (bank->regs->wkup_en && 451 !LINE_USED(bank->mod_usage, offset) && 452 !LINE_USED(bank->irq_usage, offset)) { 453 /* Disable wake-up during idle for dynamic tick */ 454 _gpio_rmw(base, bank->regs->wkup_en, BIT(offset), 0); 455 bank->context.wake_en = 456 readl_relaxed(bank->base + bank->regs->wkup_en); 457 } 458 459 if (bank->regs->ctrl && !BANK_USED(bank)) { 460 void __iomem *reg = bank->base + bank->regs->ctrl; 461 u32 ctrl; 462 463 ctrl = readl_relaxed(reg); 464 /* Module is disabled, clocks are gated */ 465 ctrl |= GPIO_MOD_CTRL_BIT; 466 writel_relaxed(ctrl, reg); 467 bank->context.ctrl = ctrl; 468 } 469 } 470 471 static int gpio_is_input(struct gpio_bank *bank, int mask) 472 { 473 void __iomem *reg = bank->base + bank->regs->direction; 474 475 return readl_relaxed(reg) & mask; 476 } 477 478 static int gpio_irq_type(struct irq_data *d, unsigned type) 479 { 480 struct gpio_bank *bank = _irq_data_get_bank(d); 481 unsigned gpio = 0; 482 int retval; 483 unsigned long flags; 484 unsigned offset; 485 486 if (!BANK_USED(bank)) 487 pm_runtime_get_sync(bank->dev); 488 489 #ifdef CONFIG_ARCH_OMAP1 490 if (d->irq > IH_MPUIO_BASE) 491 gpio = OMAP_MPUIO(d->irq - IH_MPUIO_BASE); 492 #endif 493 494 if (!gpio) 495 gpio = irq_to_gpio(bank, d->hwirq); 496 497 if (type & ~IRQ_TYPE_SENSE_MASK) 498 return -EINVAL; 499 500 if (!bank->regs->leveldetect0 && 501 (type & (IRQ_TYPE_LEVEL_LOW|IRQ_TYPE_LEVEL_HIGH))) 502 return -EINVAL; 503 504 spin_lock_irqsave(&bank->lock, flags); 505 offset = GPIO_INDEX(bank, gpio); 506 retval = _set_gpio_triggering(bank, offset, type); 507 if (!LINE_USED(bank->mod_usage, offset)) { 508 _enable_gpio_module(bank, offset); 509 _set_gpio_direction(bank, offset, 1); 510 } else if (!gpio_is_input(bank, BIT(offset))) { 511 spin_unlock_irqrestore(&bank->lock, flags); 512 return -EINVAL; 513 } 514 515 bank->irq_usage |= BIT(GPIO_INDEX(bank, gpio)); 516 spin_unlock_irqrestore(&bank->lock, flags); 517 518 if (type & (IRQ_TYPE_LEVEL_LOW | IRQ_TYPE_LEVEL_HIGH)) 519 __irq_set_handler_locked(d->irq, handle_level_irq); 520 else if (type & (IRQ_TYPE_EDGE_FALLING | IRQ_TYPE_EDGE_RISING)) 521 __irq_set_handler_locked(d->irq, handle_edge_irq); 522 523 return retval; 524 } 525 526 static void _clear_gpio_irqbank(struct gpio_bank *bank, int gpio_mask) 527 { 528 void __iomem *reg = bank->base; 529 530 reg += bank->regs->irqstatus; 531 writel_relaxed(gpio_mask, reg); 532 533 /* Workaround for clearing DSP GPIO interrupts to allow retention */ 534 if (bank->regs->irqstatus2) { 535 reg = bank->base + bank->regs->irqstatus2; 536 writel_relaxed(gpio_mask, reg); 537 } 538 539 /* Flush posted write for the irq status to avoid spurious interrupts */ 540 readl_relaxed(reg); 541 } 542 543 static inline void _clear_gpio_irqstatus(struct gpio_bank *bank, int gpio) 544 { 545 _clear_gpio_irqbank(bank, GPIO_BIT(bank, gpio)); 546 } 547 548 static u32 _get_gpio_irqbank_mask(struct gpio_bank *bank) 549 { 550 void __iomem *reg = bank->base; 551 u32 l; 552 u32 mask = (BIT(bank->width)) - 1; 553 554 reg += bank->regs->irqenable; 555 l = readl_relaxed(reg); 556 if (bank->regs->irqenable_inv) 557 l = ~l; 558 l &= mask; 559 return l; 560 } 561 562 static void _enable_gpio_irqbank(struct gpio_bank *bank, int gpio_mask) 563 { 564 void __iomem *reg = bank->base; 565 u32 l; 566 567 if (bank->regs->set_irqenable) { 568 reg += bank->regs->set_irqenable; 569 l = gpio_mask; 570 bank->context.irqenable1 |= gpio_mask; 571 } else { 572 reg += bank->regs->irqenable; 573 l = readl_relaxed(reg); 574 if (bank->regs->irqenable_inv) 575 l &= ~gpio_mask; 576 else 577 l |= gpio_mask; 578 bank->context.irqenable1 = l; 579 } 580 581 writel_relaxed(l, reg); 582 } 583 584 static void _disable_gpio_irqbank(struct gpio_bank *bank, int gpio_mask) 585 { 586 void __iomem *reg = bank->base; 587 u32 l; 588 589 if (bank->regs->clr_irqenable) { 590 reg += bank->regs->clr_irqenable; 591 l = gpio_mask; 592 bank->context.irqenable1 &= ~gpio_mask; 593 } else { 594 reg += bank->regs->irqenable; 595 l = readl_relaxed(reg); 596 if (bank->regs->irqenable_inv) 597 l |= gpio_mask; 598 else 599 l &= ~gpio_mask; 600 bank->context.irqenable1 = l; 601 } 602 603 writel_relaxed(l, reg); 604 } 605 606 static inline void _set_gpio_irqenable(struct gpio_bank *bank, int gpio, int enable) 607 { 608 if (enable) 609 _enable_gpio_irqbank(bank, GPIO_BIT(bank, gpio)); 610 else 611 _disable_gpio_irqbank(bank, GPIO_BIT(bank, gpio)); 612 } 613 614 /* 615 * Note that ENAWAKEUP needs to be enabled in GPIO_SYSCONFIG register. 616 * 1510 does not seem to have a wake-up register. If JTAG is connected 617 * to the target, system will wake up always on GPIO events. While 618 * system is running all registered GPIO interrupts need to have wake-up 619 * enabled. When system is suspended, only selected GPIO interrupts need 620 * to have wake-up enabled. 621 */ 622 static int _set_gpio_wakeup(struct gpio_bank *bank, int gpio, int enable) 623 { 624 u32 gpio_bit = GPIO_BIT(bank, gpio); 625 unsigned long flags; 626 627 if (bank->non_wakeup_gpios & gpio_bit) { 628 dev_err(bank->dev, 629 "Unable to modify wakeup on non-wakeup GPIO%d\n", gpio); 630 return -EINVAL; 631 } 632 633 spin_lock_irqsave(&bank->lock, flags); 634 if (enable) 635 bank->context.wake_en |= gpio_bit; 636 else 637 bank->context.wake_en &= ~gpio_bit; 638 639 writel_relaxed(bank->context.wake_en, bank->base + bank->regs->wkup_en); 640 spin_unlock_irqrestore(&bank->lock, flags); 641 642 return 0; 643 } 644 645 static void _reset_gpio(struct gpio_bank *bank, int gpio) 646 { 647 _set_gpio_direction(bank, GPIO_INDEX(bank, gpio), 1); 648 _set_gpio_irqenable(bank, gpio, 0); 649 _clear_gpio_irqstatus(bank, gpio); 650 _set_gpio_triggering(bank, GPIO_INDEX(bank, gpio), IRQ_TYPE_NONE); 651 _clear_gpio_debounce(bank, gpio); 652 } 653 654 /* Use disable_irq_wake() and enable_irq_wake() functions from drivers */ 655 static int gpio_wake_enable(struct irq_data *d, unsigned int enable) 656 { 657 struct gpio_bank *bank = _irq_data_get_bank(d); 658 unsigned int gpio = irq_to_gpio(bank, d->hwirq); 659 660 return _set_gpio_wakeup(bank, gpio, enable); 661 } 662 663 static int omap_gpio_request(struct gpio_chip *chip, unsigned offset) 664 { 665 struct gpio_bank *bank = container_of(chip, struct gpio_bank, chip); 666 unsigned long flags; 667 668 /* 669 * If this is the first gpio_request for the bank, 670 * enable the bank module. 671 */ 672 if (!BANK_USED(bank)) 673 pm_runtime_get_sync(bank->dev); 674 675 spin_lock_irqsave(&bank->lock, flags); 676 /* Set trigger to none. You need to enable the desired trigger with 677 * request_irq() or set_irq_type(). Only do this if the IRQ line has 678 * not already been requested. 679 */ 680 if (!LINE_USED(bank->irq_usage, offset)) { 681 _set_gpio_triggering(bank, offset, IRQ_TYPE_NONE); 682 _enable_gpio_module(bank, offset); 683 } 684 bank->mod_usage |= BIT(offset); 685 spin_unlock_irqrestore(&bank->lock, flags); 686 687 return 0; 688 } 689 690 static void omap_gpio_free(struct gpio_chip *chip, unsigned offset) 691 { 692 struct gpio_bank *bank = container_of(chip, struct gpio_bank, chip); 693 unsigned long flags; 694 695 spin_lock_irqsave(&bank->lock, flags); 696 bank->mod_usage &= ~(BIT(offset)); 697 _disable_gpio_module(bank, offset); 698 _reset_gpio(bank, bank->chip.base + offset); 699 spin_unlock_irqrestore(&bank->lock, flags); 700 701 /* 702 * If this is the last gpio to be freed in the bank, 703 * disable the bank module. 704 */ 705 if (!BANK_USED(bank)) 706 pm_runtime_put(bank->dev); 707 } 708 709 /* 710 * We need to unmask the GPIO bank interrupt as soon as possible to 711 * avoid missing GPIO interrupts for other lines in the bank. 712 * Then we need to mask-read-clear-unmask the triggered GPIO lines 713 * in the bank to avoid missing nested interrupts for a GPIO line. 714 * If we wait to unmask individual GPIO lines in the bank after the 715 * line's interrupt handler has been run, we may miss some nested 716 * interrupts. 717 */ 718 static void gpio_irq_handler(unsigned int irq, struct irq_desc *desc) 719 { 720 void __iomem *isr_reg = NULL; 721 u32 isr; 722 unsigned int bit; 723 struct gpio_bank *bank; 724 int unmasked = 0; 725 struct irq_chip *irqchip = irq_desc_get_chip(desc); 726 struct gpio_chip *chip = irq_get_handler_data(irq); 727 728 chained_irq_enter(irqchip, desc); 729 730 bank = container_of(chip, struct gpio_bank, chip); 731 isr_reg = bank->base + bank->regs->irqstatus; 732 pm_runtime_get_sync(bank->dev); 733 734 if (WARN_ON(!isr_reg)) 735 goto exit; 736 737 while (1) { 738 u32 isr_saved, level_mask = 0; 739 u32 enabled; 740 741 enabled = _get_gpio_irqbank_mask(bank); 742 isr_saved = isr = readl_relaxed(isr_reg) & enabled; 743 744 if (bank->level_mask) 745 level_mask = bank->level_mask & enabled; 746 747 /* clear edge sensitive interrupts before handler(s) are 748 called so that we don't miss any interrupt occurred while 749 executing them */ 750 _disable_gpio_irqbank(bank, isr_saved & ~level_mask); 751 _clear_gpio_irqbank(bank, isr_saved & ~level_mask); 752 _enable_gpio_irqbank(bank, isr_saved & ~level_mask); 753 754 /* if there is only edge sensitive GPIO pin interrupts 755 configured, we could unmask GPIO bank interrupt immediately */ 756 if (!level_mask && !unmasked) { 757 unmasked = 1; 758 chained_irq_exit(irqchip, desc); 759 } 760 761 if (!isr) 762 break; 763 764 while (isr) { 765 bit = __ffs(isr); 766 isr &= ~(BIT(bit)); 767 768 /* 769 * Some chips can't respond to both rising and falling 770 * at the same time. If this irq was requested with 771 * both flags, we need to flip the ICR data for the IRQ 772 * to respond to the IRQ for the opposite direction. 773 * This will be indicated in the bank toggle_mask. 774 */ 775 if (bank->toggle_mask & (BIT(bit))) 776 _toggle_gpio_edge_triggering(bank, bit); 777 778 generic_handle_irq(irq_find_mapping(bank->chip.irqdomain, 779 bit)); 780 } 781 } 782 /* if bank has any level sensitive GPIO pin interrupt 783 configured, we must unmask the bank interrupt only after 784 handler(s) are executed in order to avoid spurious bank 785 interrupt */ 786 exit: 787 if (!unmasked) 788 chained_irq_exit(irqchip, desc); 789 pm_runtime_put(bank->dev); 790 } 791 792 static void gpio_irq_shutdown(struct irq_data *d) 793 { 794 struct gpio_bank *bank = _irq_data_get_bank(d); 795 unsigned int gpio = irq_to_gpio(bank, d->hwirq); 796 unsigned long flags; 797 unsigned offset = GPIO_INDEX(bank, gpio); 798 799 spin_lock_irqsave(&bank->lock, flags); 800 gpio_unlock_as_irq(&bank->chip, offset); 801 bank->irq_usage &= ~(BIT(offset)); 802 _disable_gpio_module(bank, offset); 803 _reset_gpio(bank, gpio); 804 spin_unlock_irqrestore(&bank->lock, flags); 805 806 /* 807 * If this is the last IRQ to be freed in the bank, 808 * disable the bank module. 809 */ 810 if (!BANK_USED(bank)) 811 pm_runtime_put(bank->dev); 812 } 813 814 static void gpio_ack_irq(struct irq_data *d) 815 { 816 struct gpio_bank *bank = _irq_data_get_bank(d); 817 unsigned int gpio = irq_to_gpio(bank, d->hwirq); 818 819 _clear_gpio_irqstatus(bank, gpio); 820 } 821 822 static void gpio_mask_irq(struct irq_data *d) 823 { 824 struct gpio_bank *bank = _irq_data_get_bank(d); 825 unsigned int gpio = irq_to_gpio(bank, d->hwirq); 826 unsigned long flags; 827 828 spin_lock_irqsave(&bank->lock, flags); 829 _set_gpio_irqenable(bank, gpio, 0); 830 _set_gpio_triggering(bank, GPIO_INDEX(bank, gpio), IRQ_TYPE_NONE); 831 spin_unlock_irqrestore(&bank->lock, flags); 832 } 833 834 static void gpio_unmask_irq(struct irq_data *d) 835 { 836 struct gpio_bank *bank = _irq_data_get_bank(d); 837 unsigned int gpio = irq_to_gpio(bank, d->hwirq); 838 unsigned int irq_mask = GPIO_BIT(bank, gpio); 839 u32 trigger = irqd_get_trigger_type(d); 840 unsigned long flags; 841 842 spin_lock_irqsave(&bank->lock, flags); 843 if (trigger) 844 _set_gpio_triggering(bank, GPIO_INDEX(bank, gpio), trigger); 845 846 /* For level-triggered GPIOs, the clearing must be done after 847 * the HW source is cleared, thus after the handler has run */ 848 if (bank->level_mask & irq_mask) { 849 _set_gpio_irqenable(bank, gpio, 0); 850 _clear_gpio_irqstatus(bank, gpio); 851 } 852 853 _set_gpio_irqenable(bank, gpio, 1); 854 spin_unlock_irqrestore(&bank->lock, flags); 855 } 856 857 static struct irq_chip gpio_irq_chip = { 858 .name = "GPIO", 859 .irq_shutdown = gpio_irq_shutdown, 860 .irq_ack = gpio_ack_irq, 861 .irq_mask = gpio_mask_irq, 862 .irq_unmask = gpio_unmask_irq, 863 .irq_set_type = gpio_irq_type, 864 .irq_set_wake = gpio_wake_enable, 865 }; 866 867 /*---------------------------------------------------------------------*/ 868 869 static int omap_mpuio_suspend_noirq(struct device *dev) 870 { 871 struct platform_device *pdev = to_platform_device(dev); 872 struct gpio_bank *bank = platform_get_drvdata(pdev); 873 void __iomem *mask_reg = bank->base + 874 OMAP_MPUIO_GPIO_MASKIT / bank->stride; 875 unsigned long flags; 876 877 spin_lock_irqsave(&bank->lock, flags); 878 writel_relaxed(0xffff & ~bank->context.wake_en, mask_reg); 879 spin_unlock_irqrestore(&bank->lock, flags); 880 881 return 0; 882 } 883 884 static int omap_mpuio_resume_noirq(struct device *dev) 885 { 886 struct platform_device *pdev = to_platform_device(dev); 887 struct gpio_bank *bank = platform_get_drvdata(pdev); 888 void __iomem *mask_reg = bank->base + 889 OMAP_MPUIO_GPIO_MASKIT / bank->stride; 890 unsigned long flags; 891 892 spin_lock_irqsave(&bank->lock, flags); 893 writel_relaxed(bank->context.wake_en, mask_reg); 894 spin_unlock_irqrestore(&bank->lock, flags); 895 896 return 0; 897 } 898 899 static const struct dev_pm_ops omap_mpuio_dev_pm_ops = { 900 .suspend_noirq = omap_mpuio_suspend_noirq, 901 .resume_noirq = omap_mpuio_resume_noirq, 902 }; 903 904 /* use platform_driver for this. */ 905 static struct platform_driver omap_mpuio_driver = { 906 .driver = { 907 .name = "mpuio", 908 .pm = &omap_mpuio_dev_pm_ops, 909 }, 910 }; 911 912 static struct platform_device omap_mpuio_device = { 913 .name = "mpuio", 914 .id = -1, 915 .dev = { 916 .driver = &omap_mpuio_driver.driver, 917 } 918 /* could list the /proc/iomem resources */ 919 }; 920 921 static inline void mpuio_init(struct gpio_bank *bank) 922 { 923 platform_set_drvdata(&omap_mpuio_device, bank); 924 925 if (platform_driver_register(&omap_mpuio_driver) == 0) 926 (void) platform_device_register(&omap_mpuio_device); 927 } 928 929 /*---------------------------------------------------------------------*/ 930 931 static int gpio_get_direction(struct gpio_chip *chip, unsigned offset) 932 { 933 struct gpio_bank *bank; 934 unsigned long flags; 935 void __iomem *reg; 936 int dir; 937 938 bank = container_of(chip, struct gpio_bank, chip); 939 reg = bank->base + bank->regs->direction; 940 spin_lock_irqsave(&bank->lock, flags); 941 dir = !!(readl_relaxed(reg) & BIT(offset)); 942 spin_unlock_irqrestore(&bank->lock, flags); 943 return dir; 944 } 945 946 static int gpio_input(struct gpio_chip *chip, unsigned offset) 947 { 948 struct gpio_bank *bank; 949 unsigned long flags; 950 951 bank = container_of(chip, struct gpio_bank, chip); 952 spin_lock_irqsave(&bank->lock, flags); 953 _set_gpio_direction(bank, offset, 1); 954 spin_unlock_irqrestore(&bank->lock, flags); 955 return 0; 956 } 957 958 static int gpio_get(struct gpio_chip *chip, unsigned offset) 959 { 960 struct gpio_bank *bank; 961 u32 mask; 962 963 bank = container_of(chip, struct gpio_bank, chip); 964 mask = (BIT(offset)); 965 966 if (gpio_is_input(bank, mask)) 967 return _get_gpio_datain(bank, offset); 968 else 969 return _get_gpio_dataout(bank, offset); 970 } 971 972 static int gpio_output(struct gpio_chip *chip, unsigned offset, int value) 973 { 974 struct gpio_bank *bank; 975 unsigned long flags; 976 977 bank = container_of(chip, struct gpio_bank, chip); 978 spin_lock_irqsave(&bank->lock, flags); 979 bank->set_dataout(bank, offset, value); 980 _set_gpio_direction(bank, offset, 0); 981 spin_unlock_irqrestore(&bank->lock, flags); 982 return 0; 983 } 984 985 static int gpio_debounce(struct gpio_chip *chip, unsigned offset, 986 unsigned debounce) 987 { 988 struct gpio_bank *bank; 989 unsigned long flags; 990 991 bank = container_of(chip, struct gpio_bank, chip); 992 993 spin_lock_irqsave(&bank->lock, flags); 994 _set_gpio_debounce(bank, offset, debounce); 995 spin_unlock_irqrestore(&bank->lock, flags); 996 997 return 0; 998 } 999 1000 static void gpio_set(struct gpio_chip *chip, unsigned offset, int value) 1001 { 1002 struct gpio_bank *bank; 1003 unsigned long flags; 1004 1005 bank = container_of(chip, struct gpio_bank, chip); 1006 spin_lock_irqsave(&bank->lock, flags); 1007 bank->set_dataout(bank, offset, value); 1008 spin_unlock_irqrestore(&bank->lock, flags); 1009 } 1010 1011 /*---------------------------------------------------------------------*/ 1012 1013 static void __init omap_gpio_show_rev(struct gpio_bank *bank) 1014 { 1015 static bool called; 1016 u32 rev; 1017 1018 if (called || bank->regs->revision == USHRT_MAX) 1019 return; 1020 1021 rev = readw_relaxed(bank->base + bank->regs->revision); 1022 pr_info("OMAP GPIO hardware version %d.%d\n", 1023 (rev >> 4) & 0x0f, rev & 0x0f); 1024 1025 called = true; 1026 } 1027 1028 /* This lock class tells lockdep that GPIO irqs are in a different 1029 * category than their parents, so it won't report false recursion. 1030 */ 1031 static struct lock_class_key gpio_lock_class; 1032 1033 static void omap_gpio_mod_init(struct gpio_bank *bank) 1034 { 1035 void __iomem *base = bank->base; 1036 u32 l = 0xffffffff; 1037 1038 if (bank->width == 16) 1039 l = 0xffff; 1040 1041 if (bank->is_mpuio) { 1042 writel_relaxed(l, bank->base + bank->regs->irqenable); 1043 return; 1044 } 1045 1046 _gpio_rmw(base, bank->regs->irqenable, l, bank->regs->irqenable_inv); 1047 _gpio_rmw(base, bank->regs->irqstatus, l, !bank->regs->irqenable_inv); 1048 if (bank->regs->debounce_en) 1049 writel_relaxed(0, base + bank->regs->debounce_en); 1050 1051 /* Save OE default value (0xffffffff) in the context */ 1052 bank->context.oe = readl_relaxed(bank->base + bank->regs->direction); 1053 /* Initialize interface clk ungated, module enabled */ 1054 if (bank->regs->ctrl) 1055 writel_relaxed(0, base + bank->regs->ctrl); 1056 1057 bank->dbck = clk_get(bank->dev, "dbclk"); 1058 if (IS_ERR(bank->dbck)) 1059 dev_err(bank->dev, "Could not get gpio dbck\n"); 1060 } 1061 1062 static void 1063 omap_mpuio_alloc_gc(struct gpio_bank *bank, unsigned int irq_start, 1064 unsigned int num) 1065 { 1066 struct irq_chip_generic *gc; 1067 struct irq_chip_type *ct; 1068 1069 gc = irq_alloc_generic_chip("MPUIO", 1, irq_start, bank->base, 1070 handle_simple_irq); 1071 if (!gc) { 1072 dev_err(bank->dev, "Memory alloc failed for gc\n"); 1073 return; 1074 } 1075 1076 ct = gc->chip_types; 1077 1078 /* NOTE: No ack required, reading IRQ status clears it. */ 1079 ct->chip.irq_mask = irq_gc_mask_set_bit; 1080 ct->chip.irq_unmask = irq_gc_mask_clr_bit; 1081 ct->chip.irq_set_type = gpio_irq_type; 1082 1083 if (bank->regs->wkup_en) 1084 ct->chip.irq_set_wake = gpio_wake_enable; 1085 1086 ct->regs.mask = OMAP_MPUIO_GPIO_INT / bank->stride; 1087 irq_setup_generic_chip(gc, IRQ_MSK(num), IRQ_GC_INIT_MASK_CACHE, 1088 IRQ_NOREQUEST | IRQ_NOPROBE, 0); 1089 } 1090 1091 static int omap_gpio_chip_init(struct gpio_bank *bank) 1092 { 1093 int j; 1094 static int gpio; 1095 int irq_base = 0; 1096 int ret; 1097 1098 /* 1099 * REVISIT eventually switch from OMAP-specific gpio structs 1100 * over to the generic ones 1101 */ 1102 bank->chip.request = omap_gpio_request; 1103 bank->chip.free = omap_gpio_free; 1104 bank->chip.get_direction = gpio_get_direction; 1105 bank->chip.direction_input = gpio_input; 1106 bank->chip.get = gpio_get; 1107 bank->chip.direction_output = gpio_output; 1108 bank->chip.set_debounce = gpio_debounce; 1109 bank->chip.set = gpio_set; 1110 if (bank->is_mpuio) { 1111 bank->chip.label = "mpuio"; 1112 if (bank->regs->wkup_en) 1113 bank->chip.dev = &omap_mpuio_device.dev; 1114 bank->chip.base = OMAP_MPUIO(0); 1115 } else { 1116 bank->chip.label = "gpio"; 1117 bank->chip.base = gpio; 1118 gpio += bank->width; 1119 } 1120 bank->chip.ngpio = bank->width; 1121 1122 ret = gpiochip_add(&bank->chip); 1123 if (ret) { 1124 dev_err(bank->dev, "Could not register gpio chip %d\n", ret); 1125 return ret; 1126 } 1127 1128 #ifdef CONFIG_ARCH_OMAP1 1129 /* 1130 * REVISIT: Once we have OMAP1 supporting SPARSE_IRQ, we can drop 1131 * irq_alloc_descs() since a base IRQ offset will no longer be needed. 1132 */ 1133 irq_base = irq_alloc_descs(-1, 0, bank->width, 0); 1134 if (irq_base < 0) { 1135 dev_err(bank->dev, "Couldn't allocate IRQ numbers\n"); 1136 return -ENODEV; 1137 } 1138 #endif 1139 1140 ret = gpiochip_irqchip_add(&bank->chip, &gpio_irq_chip, 1141 irq_base, gpio_irq_handler, 1142 IRQ_TYPE_NONE); 1143 1144 if (ret) { 1145 dev_err(bank->dev, "Couldn't add irqchip to gpiochip %d\n", ret); 1146 ret = gpiochip_remove(&bank->chip); 1147 return -ENODEV; 1148 } 1149 1150 gpiochip_set_chained_irqchip(&bank->chip, &gpio_irq_chip, 1151 bank->irq, gpio_irq_handler); 1152 1153 for (j = 0; j < bank->width; j++) { 1154 int irq = irq_find_mapping(bank->chip.irqdomain, j); 1155 irq_set_lockdep_class(irq, &gpio_lock_class); 1156 if (bank->is_mpuio) { 1157 omap_mpuio_alloc_gc(bank, irq, bank->width); 1158 irq_set_chip_and_handler(irq, NULL, NULL); 1159 set_irq_flags(irq, 0); 1160 } 1161 } 1162 1163 return 0; 1164 } 1165 1166 static const struct of_device_id omap_gpio_match[]; 1167 1168 static int omap_gpio_probe(struct platform_device *pdev) 1169 { 1170 struct device *dev = &pdev->dev; 1171 struct device_node *node = dev->of_node; 1172 const struct of_device_id *match; 1173 const struct omap_gpio_platform_data *pdata; 1174 struct resource *res; 1175 struct gpio_bank *bank; 1176 int ret; 1177 1178 match = of_match_device(of_match_ptr(omap_gpio_match), dev); 1179 1180 pdata = match ? match->data : dev_get_platdata(dev); 1181 if (!pdata) 1182 return -EINVAL; 1183 1184 bank = devm_kzalloc(dev, sizeof(struct gpio_bank), GFP_KERNEL); 1185 if (!bank) { 1186 dev_err(dev, "Memory alloc failed\n"); 1187 return -ENOMEM; 1188 } 1189 1190 res = platform_get_resource(pdev, IORESOURCE_IRQ, 0); 1191 if (unlikely(!res)) { 1192 dev_err(dev, "Invalid IRQ resource\n"); 1193 return -ENODEV; 1194 } 1195 1196 bank->irq = res->start; 1197 bank->dev = dev; 1198 bank->chip.dev = dev; 1199 bank->dbck_flag = pdata->dbck_flag; 1200 bank->stride = pdata->bank_stride; 1201 bank->width = pdata->bank_width; 1202 bank->is_mpuio = pdata->is_mpuio; 1203 bank->non_wakeup_gpios = pdata->non_wakeup_gpios; 1204 bank->regs = pdata->regs; 1205 #ifdef CONFIG_OF_GPIO 1206 bank->chip.of_node = of_node_get(node); 1207 #endif 1208 if (node) { 1209 if (!of_property_read_bool(node, "ti,gpio-always-on")) 1210 bank->loses_context = true; 1211 } else { 1212 bank->loses_context = pdata->loses_context; 1213 1214 if (bank->loses_context) 1215 bank->get_context_loss_count = 1216 pdata->get_context_loss_count; 1217 } 1218 1219 if (bank->regs->set_dataout && bank->regs->clr_dataout) 1220 bank->set_dataout = _set_gpio_dataout_reg; 1221 else 1222 bank->set_dataout = _set_gpio_dataout_mask; 1223 1224 spin_lock_init(&bank->lock); 1225 1226 /* Static mapping, never released */ 1227 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 1228 bank->base = devm_ioremap_resource(dev, res); 1229 if (IS_ERR(bank->base)) { 1230 irq_domain_remove(bank->chip.irqdomain); 1231 return PTR_ERR(bank->base); 1232 } 1233 1234 platform_set_drvdata(pdev, bank); 1235 1236 pm_runtime_enable(bank->dev); 1237 pm_runtime_irq_safe(bank->dev); 1238 pm_runtime_get_sync(bank->dev); 1239 1240 if (bank->is_mpuio) 1241 mpuio_init(bank); 1242 1243 omap_gpio_mod_init(bank); 1244 1245 ret = omap_gpio_chip_init(bank); 1246 if (ret) 1247 return ret; 1248 1249 omap_gpio_show_rev(bank); 1250 1251 pm_runtime_put(bank->dev); 1252 1253 list_add_tail(&bank->node, &omap_gpio_list); 1254 1255 return 0; 1256 } 1257 1258 #ifdef CONFIG_ARCH_OMAP2PLUS 1259 1260 #if defined(CONFIG_PM_RUNTIME) 1261 static void omap_gpio_restore_context(struct gpio_bank *bank); 1262 1263 static int omap_gpio_runtime_suspend(struct device *dev) 1264 { 1265 struct platform_device *pdev = to_platform_device(dev); 1266 struct gpio_bank *bank = platform_get_drvdata(pdev); 1267 u32 l1 = 0, l2 = 0; 1268 unsigned long flags; 1269 u32 wake_low, wake_hi; 1270 1271 spin_lock_irqsave(&bank->lock, flags); 1272 1273 /* 1274 * Only edges can generate a wakeup event to the PRCM. 1275 * 1276 * Therefore, ensure any wake-up capable GPIOs have 1277 * edge-detection enabled before going idle to ensure a wakeup 1278 * to the PRCM is generated on a GPIO transition. (c.f. 34xx 1279 * NDA TRM 25.5.3.1) 1280 * 1281 * The normal values will be restored upon ->runtime_resume() 1282 * by writing back the values saved in bank->context. 1283 */ 1284 wake_low = bank->context.leveldetect0 & bank->context.wake_en; 1285 if (wake_low) 1286 writel_relaxed(wake_low | bank->context.fallingdetect, 1287 bank->base + bank->regs->fallingdetect); 1288 wake_hi = bank->context.leveldetect1 & bank->context.wake_en; 1289 if (wake_hi) 1290 writel_relaxed(wake_hi | bank->context.risingdetect, 1291 bank->base + bank->regs->risingdetect); 1292 1293 if (!bank->enabled_non_wakeup_gpios) 1294 goto update_gpio_context_count; 1295 1296 if (bank->power_mode != OFF_MODE) { 1297 bank->power_mode = 0; 1298 goto update_gpio_context_count; 1299 } 1300 /* 1301 * If going to OFF, remove triggering for all 1302 * non-wakeup GPIOs. Otherwise spurious IRQs will be 1303 * generated. See OMAP2420 Errata item 1.101. 1304 */ 1305 bank->saved_datain = readl_relaxed(bank->base + 1306 bank->regs->datain); 1307 l1 = bank->context.fallingdetect; 1308 l2 = bank->context.risingdetect; 1309 1310 l1 &= ~bank->enabled_non_wakeup_gpios; 1311 l2 &= ~bank->enabled_non_wakeup_gpios; 1312 1313 writel_relaxed(l1, bank->base + bank->regs->fallingdetect); 1314 writel_relaxed(l2, bank->base + bank->regs->risingdetect); 1315 1316 bank->workaround_enabled = true; 1317 1318 update_gpio_context_count: 1319 if (bank->get_context_loss_count) 1320 bank->context_loss_count = 1321 bank->get_context_loss_count(bank->dev); 1322 1323 _gpio_dbck_disable(bank); 1324 spin_unlock_irqrestore(&bank->lock, flags); 1325 1326 return 0; 1327 } 1328 1329 static void omap_gpio_init_context(struct gpio_bank *p); 1330 1331 static int omap_gpio_runtime_resume(struct device *dev) 1332 { 1333 struct platform_device *pdev = to_platform_device(dev); 1334 struct gpio_bank *bank = platform_get_drvdata(pdev); 1335 u32 l = 0, gen, gen0, gen1; 1336 unsigned long flags; 1337 int c; 1338 1339 spin_lock_irqsave(&bank->lock, flags); 1340 1341 /* 1342 * On the first resume during the probe, the context has not 1343 * been initialised and so initialise it now. Also initialise 1344 * the context loss count. 1345 */ 1346 if (bank->loses_context && !bank->context_valid) { 1347 omap_gpio_init_context(bank); 1348 1349 if (bank->get_context_loss_count) 1350 bank->context_loss_count = 1351 bank->get_context_loss_count(bank->dev); 1352 } 1353 1354 _gpio_dbck_enable(bank); 1355 1356 /* 1357 * In ->runtime_suspend(), level-triggered, wakeup-enabled 1358 * GPIOs were set to edge trigger also in order to be able to 1359 * generate a PRCM wakeup. Here we restore the 1360 * pre-runtime_suspend() values for edge triggering. 1361 */ 1362 writel_relaxed(bank->context.fallingdetect, 1363 bank->base + bank->regs->fallingdetect); 1364 writel_relaxed(bank->context.risingdetect, 1365 bank->base + bank->regs->risingdetect); 1366 1367 if (bank->loses_context) { 1368 if (!bank->get_context_loss_count) { 1369 omap_gpio_restore_context(bank); 1370 } else { 1371 c = bank->get_context_loss_count(bank->dev); 1372 if (c != bank->context_loss_count) { 1373 omap_gpio_restore_context(bank); 1374 } else { 1375 spin_unlock_irqrestore(&bank->lock, flags); 1376 return 0; 1377 } 1378 } 1379 } 1380 1381 if (!bank->workaround_enabled) { 1382 spin_unlock_irqrestore(&bank->lock, flags); 1383 return 0; 1384 } 1385 1386 l = readl_relaxed(bank->base + bank->regs->datain); 1387 1388 /* 1389 * Check if any of the non-wakeup interrupt GPIOs have changed 1390 * state. If so, generate an IRQ by software. This is 1391 * horribly racy, but it's the best we can do to work around 1392 * this silicon bug. 1393 */ 1394 l ^= bank->saved_datain; 1395 l &= bank->enabled_non_wakeup_gpios; 1396 1397 /* 1398 * No need to generate IRQs for the rising edge for gpio IRQs 1399 * configured with falling edge only; and vice versa. 1400 */ 1401 gen0 = l & bank->context.fallingdetect; 1402 gen0 &= bank->saved_datain; 1403 1404 gen1 = l & bank->context.risingdetect; 1405 gen1 &= ~(bank->saved_datain); 1406 1407 /* FIXME: Consider GPIO IRQs with level detections properly! */ 1408 gen = l & (~(bank->context.fallingdetect) & 1409 ~(bank->context.risingdetect)); 1410 /* Consider all GPIO IRQs needed to be updated */ 1411 gen |= gen0 | gen1; 1412 1413 if (gen) { 1414 u32 old0, old1; 1415 1416 old0 = readl_relaxed(bank->base + bank->regs->leveldetect0); 1417 old1 = readl_relaxed(bank->base + bank->regs->leveldetect1); 1418 1419 if (!bank->regs->irqstatus_raw0) { 1420 writel_relaxed(old0 | gen, bank->base + 1421 bank->regs->leveldetect0); 1422 writel_relaxed(old1 | gen, bank->base + 1423 bank->regs->leveldetect1); 1424 } 1425 1426 if (bank->regs->irqstatus_raw0) { 1427 writel_relaxed(old0 | l, bank->base + 1428 bank->regs->leveldetect0); 1429 writel_relaxed(old1 | l, bank->base + 1430 bank->regs->leveldetect1); 1431 } 1432 writel_relaxed(old0, bank->base + bank->regs->leveldetect0); 1433 writel_relaxed(old1, bank->base + bank->regs->leveldetect1); 1434 } 1435 1436 bank->workaround_enabled = false; 1437 spin_unlock_irqrestore(&bank->lock, flags); 1438 1439 return 0; 1440 } 1441 #endif /* CONFIG_PM_RUNTIME */ 1442 1443 void omap2_gpio_prepare_for_idle(int pwr_mode) 1444 { 1445 struct gpio_bank *bank; 1446 1447 list_for_each_entry(bank, &omap_gpio_list, node) { 1448 if (!BANK_USED(bank) || !bank->loses_context) 1449 continue; 1450 1451 bank->power_mode = pwr_mode; 1452 1453 pm_runtime_put_sync_suspend(bank->dev); 1454 } 1455 } 1456 1457 void omap2_gpio_resume_after_idle(void) 1458 { 1459 struct gpio_bank *bank; 1460 1461 list_for_each_entry(bank, &omap_gpio_list, node) { 1462 if (!BANK_USED(bank) || !bank->loses_context) 1463 continue; 1464 1465 pm_runtime_get_sync(bank->dev); 1466 } 1467 } 1468 1469 #if defined(CONFIG_PM_RUNTIME) 1470 static void omap_gpio_init_context(struct gpio_bank *p) 1471 { 1472 struct omap_gpio_reg_offs *regs = p->regs; 1473 void __iomem *base = p->base; 1474 1475 p->context.ctrl = readl_relaxed(base + regs->ctrl); 1476 p->context.oe = readl_relaxed(base + regs->direction); 1477 p->context.wake_en = readl_relaxed(base + regs->wkup_en); 1478 p->context.leveldetect0 = readl_relaxed(base + regs->leveldetect0); 1479 p->context.leveldetect1 = readl_relaxed(base + regs->leveldetect1); 1480 p->context.risingdetect = readl_relaxed(base + regs->risingdetect); 1481 p->context.fallingdetect = readl_relaxed(base + regs->fallingdetect); 1482 p->context.irqenable1 = readl_relaxed(base + regs->irqenable); 1483 p->context.irqenable2 = readl_relaxed(base + regs->irqenable2); 1484 1485 if (regs->set_dataout && p->regs->clr_dataout) 1486 p->context.dataout = readl_relaxed(base + regs->set_dataout); 1487 else 1488 p->context.dataout = readl_relaxed(base + regs->dataout); 1489 1490 p->context_valid = true; 1491 } 1492 1493 static void omap_gpio_restore_context(struct gpio_bank *bank) 1494 { 1495 writel_relaxed(bank->context.wake_en, 1496 bank->base + bank->regs->wkup_en); 1497 writel_relaxed(bank->context.ctrl, bank->base + bank->regs->ctrl); 1498 writel_relaxed(bank->context.leveldetect0, 1499 bank->base + bank->regs->leveldetect0); 1500 writel_relaxed(bank->context.leveldetect1, 1501 bank->base + bank->regs->leveldetect1); 1502 writel_relaxed(bank->context.risingdetect, 1503 bank->base + bank->regs->risingdetect); 1504 writel_relaxed(bank->context.fallingdetect, 1505 bank->base + bank->regs->fallingdetect); 1506 if (bank->regs->set_dataout && bank->regs->clr_dataout) 1507 writel_relaxed(bank->context.dataout, 1508 bank->base + bank->regs->set_dataout); 1509 else 1510 writel_relaxed(bank->context.dataout, 1511 bank->base + bank->regs->dataout); 1512 writel_relaxed(bank->context.oe, bank->base + bank->regs->direction); 1513 1514 if (bank->dbck_enable_mask) { 1515 writel_relaxed(bank->context.debounce, bank->base + 1516 bank->regs->debounce); 1517 writel_relaxed(bank->context.debounce_en, 1518 bank->base + bank->regs->debounce_en); 1519 } 1520 1521 writel_relaxed(bank->context.irqenable1, 1522 bank->base + bank->regs->irqenable); 1523 writel_relaxed(bank->context.irqenable2, 1524 bank->base + bank->regs->irqenable2); 1525 } 1526 #endif /* CONFIG_PM_RUNTIME */ 1527 #else 1528 #define omap_gpio_runtime_suspend NULL 1529 #define omap_gpio_runtime_resume NULL 1530 static inline void omap_gpio_init_context(struct gpio_bank *p) {} 1531 #endif 1532 1533 static const struct dev_pm_ops gpio_pm_ops = { 1534 SET_RUNTIME_PM_OPS(omap_gpio_runtime_suspend, omap_gpio_runtime_resume, 1535 NULL) 1536 }; 1537 1538 #if defined(CONFIG_OF) 1539 static struct omap_gpio_reg_offs omap2_gpio_regs = { 1540 .revision = OMAP24XX_GPIO_REVISION, 1541 .direction = OMAP24XX_GPIO_OE, 1542 .datain = OMAP24XX_GPIO_DATAIN, 1543 .dataout = OMAP24XX_GPIO_DATAOUT, 1544 .set_dataout = OMAP24XX_GPIO_SETDATAOUT, 1545 .clr_dataout = OMAP24XX_GPIO_CLEARDATAOUT, 1546 .irqstatus = OMAP24XX_GPIO_IRQSTATUS1, 1547 .irqstatus2 = OMAP24XX_GPIO_IRQSTATUS2, 1548 .irqenable = OMAP24XX_GPIO_IRQENABLE1, 1549 .irqenable2 = OMAP24XX_GPIO_IRQENABLE2, 1550 .set_irqenable = OMAP24XX_GPIO_SETIRQENABLE1, 1551 .clr_irqenable = OMAP24XX_GPIO_CLEARIRQENABLE1, 1552 .debounce = OMAP24XX_GPIO_DEBOUNCE_VAL, 1553 .debounce_en = OMAP24XX_GPIO_DEBOUNCE_EN, 1554 .ctrl = OMAP24XX_GPIO_CTRL, 1555 .wkup_en = OMAP24XX_GPIO_WAKE_EN, 1556 .leveldetect0 = OMAP24XX_GPIO_LEVELDETECT0, 1557 .leveldetect1 = OMAP24XX_GPIO_LEVELDETECT1, 1558 .risingdetect = OMAP24XX_GPIO_RISINGDETECT, 1559 .fallingdetect = OMAP24XX_GPIO_FALLINGDETECT, 1560 }; 1561 1562 static struct omap_gpio_reg_offs omap4_gpio_regs = { 1563 .revision = OMAP4_GPIO_REVISION, 1564 .direction = OMAP4_GPIO_OE, 1565 .datain = OMAP4_GPIO_DATAIN, 1566 .dataout = OMAP4_GPIO_DATAOUT, 1567 .set_dataout = OMAP4_GPIO_SETDATAOUT, 1568 .clr_dataout = OMAP4_GPIO_CLEARDATAOUT, 1569 .irqstatus = OMAP4_GPIO_IRQSTATUS0, 1570 .irqstatus2 = OMAP4_GPIO_IRQSTATUS1, 1571 .irqenable = OMAP4_GPIO_IRQSTATUSSET0, 1572 .irqenable2 = OMAP4_GPIO_IRQSTATUSSET1, 1573 .set_irqenable = OMAP4_GPIO_IRQSTATUSSET0, 1574 .clr_irqenable = OMAP4_GPIO_IRQSTATUSCLR0, 1575 .debounce = OMAP4_GPIO_DEBOUNCINGTIME, 1576 .debounce_en = OMAP4_GPIO_DEBOUNCENABLE, 1577 .ctrl = OMAP4_GPIO_CTRL, 1578 .wkup_en = OMAP4_GPIO_IRQWAKEN0, 1579 .leveldetect0 = OMAP4_GPIO_LEVELDETECT0, 1580 .leveldetect1 = OMAP4_GPIO_LEVELDETECT1, 1581 .risingdetect = OMAP4_GPIO_RISINGDETECT, 1582 .fallingdetect = OMAP4_GPIO_FALLINGDETECT, 1583 }; 1584 1585 static const struct omap_gpio_platform_data omap2_pdata = { 1586 .regs = &omap2_gpio_regs, 1587 .bank_width = 32, 1588 .dbck_flag = false, 1589 }; 1590 1591 static const struct omap_gpio_platform_data omap3_pdata = { 1592 .regs = &omap2_gpio_regs, 1593 .bank_width = 32, 1594 .dbck_flag = true, 1595 }; 1596 1597 static const struct omap_gpio_platform_data omap4_pdata = { 1598 .regs = &omap4_gpio_regs, 1599 .bank_width = 32, 1600 .dbck_flag = true, 1601 }; 1602 1603 static const struct of_device_id omap_gpio_match[] = { 1604 { 1605 .compatible = "ti,omap4-gpio", 1606 .data = &omap4_pdata, 1607 }, 1608 { 1609 .compatible = "ti,omap3-gpio", 1610 .data = &omap3_pdata, 1611 }, 1612 { 1613 .compatible = "ti,omap2-gpio", 1614 .data = &omap2_pdata, 1615 }, 1616 { }, 1617 }; 1618 MODULE_DEVICE_TABLE(of, omap_gpio_match); 1619 #endif 1620 1621 static struct platform_driver omap_gpio_driver = { 1622 .probe = omap_gpio_probe, 1623 .driver = { 1624 .name = "omap_gpio", 1625 .pm = &gpio_pm_ops, 1626 .of_match_table = of_match_ptr(omap_gpio_match), 1627 }, 1628 }; 1629 1630 /* 1631 * gpio driver register needs to be done before 1632 * machine_init functions access gpio APIs. 1633 * Hence omap_gpio_drv_reg() is a postcore_initcall. 1634 */ 1635 static int __init omap_gpio_drv_reg(void) 1636 { 1637 return platform_driver_register(&omap_gpio_driver); 1638 } 1639 postcore_initcall(omap_gpio_drv_reg); 1640