gpio-omap.c 41.8 KB
Newer Older
1 2 3
/*
 * Support functions for OMAP GPIO
 *
4
 * Copyright (C) 2003-2005 Nokia Corporation
5
 * Written by Juha Yrjölä <juha.yrjola@nokia.com>
6
 *
7 8 9
 * Copyright (C) 2009 Texas Instruments
 * Added OMAP4 support - Santosh Shilimkar <santosh.shilimkar@ti.com>
 *
10 11 12 13 14 15 16 17
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/init.h>
#include <linux/module.h>
#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 26 27
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/irqdomain.h>
28
#include <linux/irqchip/chained_irq.h>
29 30
#include <linux/gpio.h>
#include <linux/platform_data/gpio-omap.h>
31

32 33
#define OFF_MODE	1

34 35
static LIST_HEAD(omap_gpio_list);

36 37 38 39 40 41 42 43 44 45 46
struct gpio_regs {
	u32 irqenable1;
	u32 irqenable2;
	u32 wake_en;
	u32 ctrl;
	u32 oe;
	u32 leveldetect0;
	u32 leveldetect1;
	u32 risingdetect;
	u32 fallingdetect;
	u32 dataout;
47 48
	u32 debounce;
	u32 debounce_en;
49 50
};

51
struct gpio_bank {
52
	struct list_head node;
53
	void __iomem *base;
54
	u16 irq;
55
	struct irq_domain *domain;
56 57
	u32 non_wakeup_gpios;
	u32 enabled_non_wakeup_gpios;
58
	struct gpio_regs context;
59
	u32 saved_datain;
60
	u32 level_mask;
61
	u32 toggle_mask;
62
	spinlock_t lock;
D
David Brownell 已提交
63
	struct gpio_chip chip;
64
	struct clk *dbck;
C
Charulatha V 已提交
65
	u32 mod_usage;
66
	u32 irq_usage;
67
	u32 dbck_enable_mask;
68
	bool dbck_enabled;
69
	struct device *dev;
70
	bool is_mpuio;
71
	bool dbck_flag;
72
	bool loses_context;
73
	bool context_valid;
74
	int stride;
75
	u32 width;
76
	int context_loss_count;
77 78
	int power_mode;
	bool workaround_enabled;
79 80

	void (*set_dataout)(struct gpio_bank *bank, int gpio, int enable);
81
	int (*get_context_loss_count)(struct device *dev);
82 83

	struct omap_gpio_reg_offs *regs;
84 85
};

86 87
#define GPIO_INDEX(bank, gpio) (gpio % bank->width)
#define GPIO_BIT(bank, gpio) (1 << GPIO_INDEX(bank, gpio))
88
#define GPIO_MOD_CTRL_BIT	BIT(0)
89

90 91 92
#define BANK_USED(bank) (bank->mod_usage || bank->irq_usage)
#define LINE_USED(line, offset) (line & (1 << offset))

93 94
static int irq_to_gpio(struct gpio_bank *bank, unsigned int gpio_irq)
{
95 96 97 98 99 100 101 102
	return bank->chip.base + gpio_irq;
}

static int omap_gpio_to_irq(struct gpio_chip *chip, unsigned offset)
{
	struct gpio_bank *bank = container_of(chip, struct gpio_bank, chip);

	return irq_find_mapping(bank->domain, offset);
103 104
}

105 106
static void _set_gpio_direction(struct gpio_bank *bank, int gpio, int is_input)
{
107
	void __iomem *reg = bank->base;
108 109
	u32 l;

110
	reg += bank->regs->direction;
111 112 113 114 115 116
	l = __raw_readl(reg);
	if (is_input)
		l |= 1 << gpio;
	else
		l &= ~(1 << gpio);
	__raw_writel(l, reg);
117
	bank->context.oe = l;
118 119
}

120 121 122

/* set data out value using dedicate set/clear register */
static void _set_gpio_dataout_reg(struct gpio_bank *bank, int gpio, int enable)
123
{
124
	void __iomem *reg = bank->base;
125
	u32 l = GPIO_BIT(bank, gpio);
126

127
	if (enable) {
128
		reg += bank->regs->set_dataout;
129 130
		bank->context.dataout |= l;
	} else {
131
		reg += bank->regs->clr_dataout;
132 133
		bank->context.dataout &= ~l;
	}
134 135 136 137

	__raw_writel(l, reg);
}

138 139
/* set data out value using mask register */
static void _set_gpio_dataout_mask(struct gpio_bank *bank, int gpio, int enable)
140
{
141 142 143
	void __iomem *reg = bank->base + bank->regs->dataout;
	u32 gpio_bit = GPIO_BIT(bank, gpio);
	u32 l;
144

145 146 147 148 149
	l = __raw_readl(reg);
	if (enable)
		l |= gpio_bit;
	else
		l &= ~gpio_bit;
150
	__raw_writel(l, reg);
151
	bank->context.dataout = l;
152 153
}

154
static int _get_gpio_datain(struct gpio_bank *bank, int offset)
155
{
156
	void __iomem *reg = bank->base + bank->regs->datain;
157

158
	return (__raw_readl(reg) & (1 << offset)) != 0;
159
}
160

161
static int _get_gpio_dataout(struct gpio_bank *bank, int offset)
162
{
163
	void __iomem *reg = bank->base + bank->regs->dataout;
164

165
	return (__raw_readl(reg) & (1 << offset)) != 0;
166 167
}

168 169 170 171
static inline void _gpio_rmw(void __iomem *base, u32 reg, u32 mask, bool set)
{
	int l = __raw_readl(base + reg);

172
	if (set)
173 174 175 176 177 178
		l |= mask;
	else
		l &= ~mask;

	__raw_writel(l, base + reg);
}
179

180 181 182 183 184
static inline void _gpio_dbck_enable(struct gpio_bank *bank)
{
	if (bank->dbck_enable_mask && !bank->dbck_enabled) {
		clk_enable(bank->dbck);
		bank->dbck_enabled = true;
185 186 187

		__raw_writel(bank->dbck_enable_mask,
			     bank->base + bank->regs->debounce_en);
188 189 190 191 192 193
	}
}

static inline void _gpio_dbck_disable(struct gpio_bank *bank)
{
	if (bank->dbck_enable_mask && bank->dbck_enabled) {
194 195 196 197 198 199 200
		/*
		 * Disable debounce before cutting it's clock. If debounce is
		 * enabled but the clock is not, GPIO module seems to be unable
		 * to detect events and generate interrupts at least on OMAP3.
		 */
		__raw_writel(0, bank->base + bank->regs->debounce_en);

201 202 203 204 205
		clk_disable(bank->dbck);
		bank->dbck_enabled = false;
	}
}

206 207 208 209 210 211 212 213 214 215 216 217
/**
 * _set_gpio_debounce - low level gpio debounce time
 * @bank: the gpio bank we're acting upon
 * @gpio: the gpio number on this @gpio
 * @debounce: debounce time to use
 *
 * OMAP's debounce time is in 31us steps so we need
 * to convert and round up to the closest unit.
 */
static void _set_gpio_debounce(struct gpio_bank *bank, unsigned gpio,
		unsigned debounce)
{
218
	void __iomem		*reg;
219 220 221
	u32			val;
	u32			l;

222 223 224
	if (!bank->dbck_flag)
		return;

225 226 227 228 229 230 231
	if (debounce < 32)
		debounce = 0x01;
	else if (debounce > 7936)
		debounce = 0xff;
	else
		debounce = (debounce / 0x1f) - 1;

232
	l = GPIO_BIT(bank, gpio);
233

234
	clk_enable(bank->dbck);
235
	reg = bank->base + bank->regs->debounce;
236 237
	__raw_writel(debounce, reg);

238
	reg = bank->base + bank->regs->debounce_en;
239 240
	val = __raw_readl(reg);

241
	if (debounce)
242
		val |= l;
243
	else
244
		val &= ~l;
245
	bank->dbck_enable_mask = val;
246 247

	__raw_writel(val, reg);
248 249 250 251 252 253 254 255 256 257
	clk_disable(bank->dbck);
	/*
	 * Enable debounce clock per module.
	 * This call is mandatory because in omap_gpio_request() when
	 * *_runtime_get_sync() is called,  _gpio_dbck_enable() within
	 * runtime callbck fails to turn on dbck because dbck_enable_mask
	 * used within _gpio_dbck_enable() is still not initialized at
	 * that point. Therefore we have to enable dbck here.
	 */
	_gpio_dbck_enable(bank);
258 259 260 261
	if (bank->dbck_enable_mask) {
		bank->context.debounce = debounce;
		bank->context.debounce_en = val;
	}
262 263
}

264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297
/**
 * _clear_gpio_debounce - clear debounce settings for a gpio
 * @bank: the gpio bank we're acting upon
 * @gpio: the gpio number on this @gpio
 *
 * If a gpio is using debounce, then clear the debounce enable bit and if
 * this is the only gpio in this bank using debounce, then clear the debounce
 * time too. The debounce clock will also be disabled when calling this function
 * if this is the only gpio in the bank using debounce.
 */
static void _clear_gpio_debounce(struct gpio_bank *bank, unsigned gpio)
{
	u32 gpio_bit = GPIO_BIT(bank, gpio);

	if (!bank->dbck_flag)
		return;

	if (!(bank->dbck_enable_mask & gpio_bit))
		return;

	bank->dbck_enable_mask &= ~gpio_bit;
	bank->context.debounce_en &= ~gpio_bit;
	__raw_writel(bank->context.debounce_en,
		     bank->base + bank->regs->debounce_en);

	if (!bank->dbck_enable_mask) {
		bank->context.debounce = 0;
		__raw_writel(bank->context.debounce, bank->base +
			     bank->regs->debounce);
		clk_disable(bank->dbck);
		bank->dbck_enabled = false;
	}
}

298
static inline void set_gpio_trigger(struct gpio_bank *bank, int gpio,
299
						unsigned trigger)
300
{
301
	void __iomem *base = bank->base;
302 303
	u32 gpio_bit = 1 << gpio;

304 305 306 307 308 309 310 311 312
	_gpio_rmw(base, bank->regs->leveldetect0, gpio_bit,
		  trigger & IRQ_TYPE_LEVEL_LOW);
	_gpio_rmw(base, bank->regs->leveldetect1, gpio_bit,
		  trigger & IRQ_TYPE_LEVEL_HIGH);
	_gpio_rmw(base, bank->regs->risingdetect, gpio_bit,
		  trigger & IRQ_TYPE_EDGE_RISING);
	_gpio_rmw(base, bank->regs->fallingdetect, gpio_bit,
		  trigger & IRQ_TYPE_EDGE_FALLING);

313 314 315 316 317 318 319 320 321 322
	bank->context.leveldetect0 =
			__raw_readl(bank->base + bank->regs->leveldetect0);
	bank->context.leveldetect1 =
			__raw_readl(bank->base + bank->regs->leveldetect1);
	bank->context.risingdetect =
			__raw_readl(bank->base + bank->regs->risingdetect);
	bank->context.fallingdetect =
			__raw_readl(bank->base + bank->regs->fallingdetect);

	if (likely(!(bank->non_wakeup_gpios & gpio_bit))) {
323
		_gpio_rmw(base, bank->regs->wkup_en, gpio_bit, trigger != 0);
324 325 326
		bank->context.wake_en =
			__raw_readl(bank->base + bank->regs->wkup_en);
	}
327

328
	/* This part needs to be executed always for OMAP{34xx, 44xx} */
329 330 331 332 333 334 335
	if (!bank->regs->irqctrl) {
		/* On omap24xx proceed only when valid GPIO bit is set */
		if (bank->non_wakeup_gpios) {
			if (!(bank->non_wakeup_gpios & gpio_bit))
				goto exit;
		}

336 337 338 339 340 341 342
		/*
		 * Log the edge gpio and manually trigger the IRQ
		 * after resume if the input level changes
		 * to avoid irq lost during PER RET/OFF mode
		 * Applies for omap2 non-wakeup gpio and all omap3 gpios
		 */
		if (trigger & IRQ_TYPE_EDGE_BOTH)
343 344 345 346
			bank->enabled_non_wakeup_gpios |= gpio_bit;
		else
			bank->enabled_non_wakeup_gpios &= ~gpio_bit;
	}
347

348
exit:
349 350 351
	bank->level_mask =
		__raw_readl(bank->base + bank->regs->leveldetect0) |
		__raw_readl(bank->base + bank->regs->leveldetect1);
352 353
}

354
#ifdef CONFIG_ARCH_OMAP1
355 356 357 358 359 360 361 362 363
/*
 * This only applies to chips that can't do both rising and falling edge
 * detection at once.  For all other chips, this function is a noop.
 */
static void _toggle_gpio_edge_triggering(struct gpio_bank *bank, int gpio)
{
	void __iomem *reg = bank->base;
	u32 l = 0;

364
	if (!bank->regs->irqctrl)
365
		return;
366 367

	reg += bank->regs->irqctrl;
368 369 370 371 372 373 374 375 376

	l = __raw_readl(reg);
	if ((l >> gpio) & 1)
		l &= ~(1 << gpio);
	else
		l |= 1 << gpio;

	__raw_writel(l, reg);
}
377 378
#else
static void _toggle_gpio_edge_triggering(struct gpio_bank *bank, int gpio) {}
379
#endif
380

381 382
static int _set_gpio_triggering(struct gpio_bank *bank, int gpio,
							unsigned trigger)
383 384
{
	void __iomem *reg = bank->base;
385
	void __iomem *base = bank->base;
386
	u32 l = 0;
387

388 389 390 391 392
	if (bank->regs->leveldetect0 && bank->regs->wkup_en) {
		set_gpio_trigger(bank, gpio, trigger);
	} else if (bank->regs->irqctrl) {
		reg += bank->regs->irqctrl;

393
		l = __raw_readl(reg);
394
		if ((trigger & IRQ_TYPE_SENSE_MASK) == IRQ_TYPE_EDGE_BOTH)
395
			bank->toggle_mask |= 1 << gpio;
396
		if (trigger & IRQ_TYPE_EDGE_RISING)
397
			l |= 1 << gpio;
398
		else if (trigger & IRQ_TYPE_EDGE_FALLING)
399
			l &= ~(1 << gpio);
400
		else
401 402 403 404
			return -EINVAL;

		__raw_writel(l, reg);
	} else if (bank->regs->edgectrl1) {
405
		if (gpio & 0x08)
406
			reg += bank->regs->edgectrl2;
407
		else
408 409
			reg += bank->regs->edgectrl1;

410 411 412
		gpio &= 0x07;
		l = __raw_readl(reg);
		l &= ~(3 << (gpio << 1));
413
		if (trigger & IRQ_TYPE_EDGE_RISING)
414
			l |= 2 << (gpio << 1);
415
		if (trigger & IRQ_TYPE_EDGE_FALLING)
416
			l |= 1 << (gpio << 1);
417 418 419

		/* Enable wake-up during idle for dynamic tick */
		_gpio_rmw(base, bank->regs->wkup_en, 1 << gpio, trigger);
420 421
		bank->context.wake_en =
			__raw_readl(bank->base + bank->regs->wkup_en);
422
		__raw_writel(l, reg);
423
	}
424
	return 0;
425 426
}

427 428 429 430 431 432 433
static int gpio_is_input(struct gpio_bank *bank, int mask)
{
	void __iomem *reg = bank->base + bank->regs->direction;

	return __raw_readl(reg) & mask;
}

434
static int gpio_irq_type(struct irq_data *d, unsigned type)
435
{
436
	struct gpio_bank *bank = irq_data_get_irq_chip_data(d);
437
	unsigned gpio = 0;
438
	int retval;
D
David Brownell 已提交
439
	unsigned long flags;
440

441
	if (WARN_ON(!BANK_USED(bank)))
442 443
		return -EINVAL;

444 445
#ifdef CONFIG_ARCH_OMAP1
	if (d->irq > IH_MPUIO_BASE)
446
		gpio = OMAP_MPUIO(d->irq - IH_MPUIO_BASE);
447 448 449
#endif

	if (!gpio)
450
		gpio = irq_to_gpio(bank, d->hwirq);
451

452
	if (type & ~IRQ_TYPE_SENSE_MASK)
453
		return -EINVAL;
454

455 456
	if (!bank->regs->leveldetect0 &&
		(type & (IRQ_TYPE_LEVEL_LOW|IRQ_TYPE_LEVEL_HIGH)))
457 458
		return -EINVAL;

D
David Brownell 已提交
459
	spin_lock_irqsave(&bank->lock, flags);
460
	retval = _set_gpio_triggering(bank, GPIO_INDEX(bank, gpio), type);
461
	bank->irq_usage |= 1 << GPIO_INDEX(bank, gpio);
D
David Brownell 已提交
462
	spin_unlock_irqrestore(&bank->lock, flags);
463 464

	if (type & (IRQ_TYPE_LEVEL_LOW | IRQ_TYPE_LEVEL_HIGH))
T
Thomas Gleixner 已提交
465
		__irq_set_handler_locked(d->irq, handle_level_irq);
466
	else if (type & (IRQ_TYPE_EDGE_FALLING | IRQ_TYPE_EDGE_RISING))
T
Thomas Gleixner 已提交
467
		__irq_set_handler_locked(d->irq, handle_edge_irq);
468

469
	return retval;
470 471 472 473
}

static void _clear_gpio_irqbank(struct gpio_bank *bank, int gpio_mask)
{
474
	void __iomem *reg = bank->base;
475

476
	reg += bank->regs->irqstatus;
477
	__raw_writel(gpio_mask, reg);
478 479

	/* Workaround for clearing DSP GPIO interrupts to allow retention */
480 481
	if (bank->regs->irqstatus2) {
		reg = bank->base + bank->regs->irqstatus2;
482
		__raw_writel(gpio_mask, reg);
483
	}
484 485 486

	/* Flush posted write for the irq status to avoid spurious interrupts */
	__raw_readl(reg);
487 488 489 490
}

static inline void _clear_gpio_irqstatus(struct gpio_bank *bank, int gpio)
{
491
	_clear_gpio_irqbank(bank, GPIO_BIT(bank, gpio));
492 493
}

494 495 496
static u32 _get_gpio_irqbank_mask(struct gpio_bank *bank)
{
	void __iomem *reg = bank->base;
497
	u32 l;
498
	u32 mask = (1 << bank->width) - 1;
499

500
	reg += bank->regs->irqenable;
501
	l = __raw_readl(reg);
502
	if (bank->regs->irqenable_inv)
503 504 505
		l = ~l;
	l &= mask;
	return l;
506 507
}

508
static void _enable_gpio_irqbank(struct gpio_bank *bank, int gpio_mask)
509
{
510
	void __iomem *reg = bank->base;
511 512
	u32 l;

513 514 515
	if (bank->regs->set_irqenable) {
		reg += bank->regs->set_irqenable;
		l = gpio_mask;
516
		bank->context.irqenable1 |= gpio_mask;
517 518
	} else {
		reg += bank->regs->irqenable;
519
		l = __raw_readl(reg);
520 521
		if (bank->regs->irqenable_inv)
			l &= ~gpio_mask;
522 523
		else
			l |= gpio_mask;
524
		bank->context.irqenable1 = l;
525 526 527 528 529 530 531 532 533 534 535 536
	}

	__raw_writel(l, reg);
}

static void _disable_gpio_irqbank(struct gpio_bank *bank, int gpio_mask)
{
	void __iomem *reg = bank->base;
	u32 l;

	if (bank->regs->clr_irqenable) {
		reg += bank->regs->clr_irqenable;
537
		l = gpio_mask;
538
		bank->context.irqenable1 &= ~gpio_mask;
539 540
	} else {
		reg += bank->regs->irqenable;
541
		l = __raw_readl(reg);
542
		if (bank->regs->irqenable_inv)
543
			l |= gpio_mask;
544
		else
545
			l &= ~gpio_mask;
546
		bank->context.irqenable1 = l;
547
	}
548

549 550 551 552 553
	__raw_writel(l, reg);
}

static inline void _set_gpio_irqenable(struct gpio_bank *bank, int gpio, int enable)
{
554 555 556 557
	if (enable)
		_enable_gpio_irqbank(bank, GPIO_BIT(bank, gpio));
	else
		_disable_gpio_irqbank(bank, GPIO_BIT(bank, gpio));
558 559
}

560 561 562 563 564 565 566 567 568 569
/*
 * Note that ENAWAKEUP needs to be enabled in GPIO_SYSCONFIG register.
 * 1510 does not seem to have a wake-up register. If JTAG is connected
 * to the target, system will wake up always on GPIO events. While
 * system is running all registered GPIO interrupts need to have wake-up
 * enabled. When system is suspended, only selected GPIO interrupts need
 * to have wake-up enabled.
 */
static int _set_gpio_wakeup(struct gpio_bank *bank, int gpio, int enable)
{
570 571
	u32 gpio_bit = GPIO_BIT(bank, gpio);
	unsigned long flags;
D
David Brownell 已提交
572

573
	if (bank->non_wakeup_gpios & gpio_bit) {
574
		dev_err(bank->dev,
575
			"Unable to modify wakeup on non-wakeup GPIO%d\n", gpio);
576 577
		return -EINVAL;
	}
578 579 580

	spin_lock_irqsave(&bank->lock, flags);
	if (enable)
581
		bank->context.wake_en |= gpio_bit;
582
	else
583
		bank->context.wake_en &= ~gpio_bit;
584

585
	__raw_writel(bank->context.wake_en, bank->base + bank->regs->wkup_en);
586 587 588
	spin_unlock_irqrestore(&bank->lock, flags);

	return 0;
589 590
}

591 592
static void _reset_gpio(struct gpio_bank *bank, int gpio)
{
593
	_set_gpio_direction(bank, GPIO_INDEX(bank, gpio), 1);
594 595
	_set_gpio_irqenable(bank, gpio, 0);
	_clear_gpio_irqstatus(bank, gpio);
596
	_set_gpio_triggering(bank, GPIO_INDEX(bank, gpio), IRQ_TYPE_NONE);
597
	_clear_gpio_debounce(bank, gpio);
598 599
}

600
/* Use disable_irq_wake() and enable_irq_wake() functions from drivers */
601
static int gpio_wake_enable(struct irq_data *d, unsigned int enable)
602
{
603
	struct gpio_bank *bank = irq_data_get_irq_chip_data(d);
604
	unsigned int gpio = irq_to_gpio(bank, d->hwirq);
605

606
	return _set_gpio_wakeup(bank, gpio, enable);
607 608
}

609
static int omap_gpio_request(struct gpio_chip *chip, unsigned offset)
610
{
611
	struct gpio_bank *bank = container_of(chip, struct gpio_bank, chip);
D
David Brownell 已提交
612
	unsigned long flags;
D
David Brownell 已提交
613

614 615 616 617
	/*
	 * If this is the first gpio_request for the bank,
	 * enable the bank module.
	 */
618
	if (!BANK_USED(bank))
619
		pm_runtime_get_sync(bank->dev);
620

621
	spin_lock_irqsave(&bank->lock, flags);
622 623 624
	/* Set trigger to none. You need to enable the desired trigger with
	 * request_irq() or set_irq_type().
	 */
625
	_set_gpio_triggering(bank, offset, IRQ_TYPE_NONE);
626

627 628
	if (bank->regs->pinctrl) {
		void __iomem *reg = bank->base + bank->regs->pinctrl;
629

630
		/* Claim the pin for MPU */
631
		__raw_writel(__raw_readl(reg) | (1 << offset), reg);
632
	}
633

634
	if (bank->regs->ctrl && !BANK_USED(bank)) {
635 636 637 638 639 640 641
		void __iomem *reg = bank->base + bank->regs->ctrl;
		u32 ctrl;

		ctrl = __raw_readl(reg);
		/* Module is enabled, clocks are not gated */
		ctrl &= ~GPIO_MOD_CTRL_BIT;
		__raw_writel(ctrl, reg);
642
		bank->context.ctrl = ctrl;
C
Charulatha V 已提交
643
	}
644 645 646

	bank->mod_usage |= 1 << offset;

D
David Brownell 已提交
647
	spin_unlock_irqrestore(&bank->lock, flags);
648 649 650 651

	return 0;
}

652
static void omap_gpio_free(struct gpio_chip *chip, unsigned offset)
653
{
654
	struct gpio_bank *bank = container_of(chip, struct gpio_bank, chip);
655
	void __iomem *base = bank->base;
D
David Brownell 已提交
656
	unsigned long flags;
657

D
David Brownell 已提交
658
	spin_lock_irqsave(&bank->lock, flags);
659

660
	if (bank->regs->wkup_en) {
661
		/* Disable wake-up during idle for dynamic tick */
662
		_gpio_rmw(base, bank->regs->wkup_en, 1 << offset, 0);
663 664 665
		bank->context.wake_en =
			__raw_readl(bank->base + bank->regs->wkup_en);
	}
666

667 668
	bank->mod_usage &= ~(1 << offset);

669
	if (bank->regs->ctrl && !BANK_USED(bank)) {
670 671 672 673 674 675 676
		void __iomem *reg = bank->base + bank->regs->ctrl;
		u32 ctrl;

		ctrl = __raw_readl(reg);
		/* Module is disabled, clocks are gated */
		ctrl |= GPIO_MOD_CTRL_BIT;
		__raw_writel(ctrl, reg);
677
		bank->context.ctrl = ctrl;
C
Charulatha V 已提交
678
	}
679

680
	_reset_gpio(bank, bank->chip.base + offset);
D
David Brownell 已提交
681
	spin_unlock_irqrestore(&bank->lock, flags);
682 683 684 685 686

	/*
	 * If this is the last gpio to be freed in the bank,
	 * disable the bank module.
	 */
687
	if (!BANK_USED(bank))
688
		pm_runtime_put(bank->dev);
689 690 691 692 693 694 695 696 697 698 699
}

/*
 * We need to unmask the GPIO bank interrupt as soon as possible to
 * avoid missing GPIO interrupts for other lines in the bank.
 * Then we need to mask-read-clear-unmask the triggered GPIO lines
 * in the bank to avoid missing nested interrupts for a GPIO line.
 * If we wait to unmask individual GPIO lines in the bank after the
 * line's interrupt handler has been run, we may miss some nested
 * interrupts.
 */
700
static void gpio_irq_handler(unsigned int irq, struct irq_desc *desc)
701
{
702
	void __iomem *isr_reg = NULL;
703
	u32 isr;
704
	unsigned int bit;
705
	struct gpio_bank *bank;
706
	int unmasked = 0;
707
	struct irq_chip *chip = irq_desc_get_chip(desc);
708

709
	chained_irq_enter(chip, desc);
710

T
Thomas Gleixner 已提交
711
	bank = irq_get_handler_data(irq);
712
	isr_reg = bank->base + bank->regs->irqstatus;
713
	pm_runtime_get_sync(bank->dev);
714 715 716 717

	if (WARN_ON(!isr_reg))
		goto exit;

718
	while (1) {
719
		u32 isr_saved, level_mask = 0;
720
		u32 enabled;
721

722 723
		enabled = _get_gpio_irqbank_mask(bank);
		isr_saved = isr = __raw_readl(isr_reg) & enabled;
724

725
		if (bank->level_mask)
726
			level_mask = bank->level_mask & enabled;
727 728 729 730

		/* clear edge sensitive interrupts before handler(s) are
		called so that we don't miss any interrupt occurred while
		executing them */
731
		_disable_gpio_irqbank(bank, isr_saved & ~level_mask);
732
		_clear_gpio_irqbank(bank, isr_saved & ~level_mask);
733
		_enable_gpio_irqbank(bank, isr_saved & ~level_mask);
734 735 736

		/* if there is only edge sensitive GPIO pin interrupts
		configured, we could unmask GPIO bank interrupt immediately */
737 738
		if (!level_mask && !unmasked) {
			unmasked = 1;
739
			chained_irq_exit(chip, desc);
740
		}
741 742 743 744

		if (!isr)
			break;

745 746 747
		while (isr) {
			bit = __ffs(isr);
			isr &= ~(1 << bit);
748

749 750 751 752 753 754 755
			/*
			 * Some chips can't respond to both rising and falling
			 * at the same time.  If this irq was requested with
			 * both flags, we need to flip the ICR data for the IRQ
			 * to respond to the IRQ for the opposite direction.
			 * This will be indicated in the bank toggle_mask.
			 */
756 757
			if (bank->toggle_mask & (1 << bit))
				_toggle_gpio_edge_triggering(bank, bit);
758

759
			generic_handle_irq(irq_find_mapping(bank->domain, bit));
760
		}
761
	}
762 763 764 765
	/* if bank has any level sensitive GPIO pin interrupt
	configured, we must unmask the bank interrupt only after
	handler(s) are executed in order to avoid spurious bank
	interrupt */
766
exit:
767
	if (!unmasked)
768
		chained_irq_exit(chip, desc);
769
	pm_runtime_put(bank->dev);
770 771
}

772
static void gpio_irq_shutdown(struct irq_data *d)
773
{
774
	struct gpio_bank *bank = irq_data_get_irq_chip_data(d);
775
	unsigned int gpio = irq_to_gpio(bank, d->hwirq);
776
	unsigned long flags;
777
	unsigned offset = GPIO_INDEX(bank, gpio);
778

779
	spin_lock_irqsave(&bank->lock, flags);
780
	bank->irq_usage &= ~(1 << offset);
781
	_reset_gpio(bank, gpio);
782
	spin_unlock_irqrestore(&bank->lock, flags);
783 784
}

785
static void gpio_ack_irq(struct irq_data *d)
786
{
787
	struct gpio_bank *bank = irq_data_get_irq_chip_data(d);
788
	unsigned int gpio = irq_to_gpio(bank, d->hwirq);
789 790 791 792

	_clear_gpio_irqstatus(bank, gpio);
}

793
static void gpio_mask_irq(struct irq_data *d)
794
{
795
	struct gpio_bank *bank = irq_data_get_irq_chip_data(d);
796
	unsigned int gpio = irq_to_gpio(bank, d->hwirq);
797
	unsigned long flags;
798

799
	spin_lock_irqsave(&bank->lock, flags);
800
	_set_gpio_irqenable(bank, gpio, 0);
801
	_set_gpio_triggering(bank, GPIO_INDEX(bank, gpio), IRQ_TYPE_NONE);
802
	spin_unlock_irqrestore(&bank->lock, flags);
803 804
}

805
static void gpio_unmask_irq(struct irq_data *d)
806
{
807
	struct gpio_bank *bank = irq_data_get_irq_chip_data(d);
808
	unsigned int gpio = irq_to_gpio(bank, d->hwirq);
809
	unsigned int irq_mask = GPIO_BIT(bank, gpio);
810
	u32 trigger = irqd_get_trigger_type(d);
811
	unsigned long flags;
812

813
	spin_lock_irqsave(&bank->lock, flags);
814
	if (trigger)
815
		_set_gpio_triggering(bank, GPIO_INDEX(bank, gpio), trigger);
816 817 818 819 820 821 822

	/* For level-triggered GPIOs, the clearing must be done after
	 * the HW source is cleared, thus after the handler has run */
	if (bank->level_mask & irq_mask) {
		_set_gpio_irqenable(bank, gpio, 0);
		_clear_gpio_irqstatus(bank, gpio);
	}
823

K
Kevin Hilman 已提交
824
	_set_gpio_irqenable(bank, gpio, 1);
825
	spin_unlock_irqrestore(&bank->lock, flags);
826 827
}

828 829
static struct irq_chip gpio_irq_chip = {
	.name		= "GPIO",
830 831 832 833 834 835
	.irq_shutdown	= gpio_irq_shutdown,
	.irq_ack	= gpio_ack_irq,
	.irq_mask	= gpio_mask_irq,
	.irq_unmask	= gpio_unmask_irq,
	.irq_set_type	= gpio_irq_type,
	.irq_set_wake	= gpio_wake_enable,
836 837 838 839
};

/*---------------------------------------------------------------------*/

840
static int omap_mpuio_suspend_noirq(struct device *dev)
D
David Brownell 已提交
841
{
842
	struct platform_device *pdev = to_platform_device(dev);
D
David Brownell 已提交
843
	struct gpio_bank	*bank = platform_get_drvdata(pdev);
844 845
	void __iomem		*mask_reg = bank->base +
					OMAP_MPUIO_GPIO_MASKIT / bank->stride;
D
David Brownell 已提交
846
	unsigned long		flags;
D
David Brownell 已提交
847

D
David Brownell 已提交
848
	spin_lock_irqsave(&bank->lock, flags);
849
	__raw_writel(0xffff & ~bank->context.wake_en, mask_reg);
D
David Brownell 已提交
850
	spin_unlock_irqrestore(&bank->lock, flags);
D
David Brownell 已提交
851 852 853 854

	return 0;
}

855
static int omap_mpuio_resume_noirq(struct device *dev)
D
David Brownell 已提交
856
{
857
	struct platform_device *pdev = to_platform_device(dev);
D
David Brownell 已提交
858
	struct gpio_bank	*bank = platform_get_drvdata(pdev);
859 860
	void __iomem		*mask_reg = bank->base +
					OMAP_MPUIO_GPIO_MASKIT / bank->stride;
D
David Brownell 已提交
861
	unsigned long		flags;
D
David Brownell 已提交
862

D
David Brownell 已提交
863
	spin_lock_irqsave(&bank->lock, flags);
864
	__raw_writel(bank->context.wake_en, mask_reg);
D
David Brownell 已提交
865
	spin_unlock_irqrestore(&bank->lock, flags);
D
David Brownell 已提交
866 867 868 869

	return 0;
}

870
static const struct dev_pm_ops omap_mpuio_dev_pm_ops = {
871 872 873 874
	.suspend_noirq = omap_mpuio_suspend_noirq,
	.resume_noirq = omap_mpuio_resume_noirq,
};

875
/* use platform_driver for this. */
D
David Brownell 已提交
876 877 878
static struct platform_driver omap_mpuio_driver = {
	.driver		= {
		.name	= "mpuio",
879
		.pm	= &omap_mpuio_dev_pm_ops,
D
David Brownell 已提交
880 881 882 883 884 885 886 887 888 889 890 891
	},
};

static struct platform_device omap_mpuio_device = {
	.name		= "mpuio",
	.id		= -1,
	.dev = {
		.driver = &omap_mpuio_driver.driver,
	}
	/* could list the /proc/iomem resources */
};

892
static inline void mpuio_init(struct gpio_bank *bank)
D
David Brownell 已提交
893
{
894
	platform_set_drvdata(&omap_mpuio_device, bank);
895

D
David Brownell 已提交
896 897 898 899
	if (platform_driver_register(&omap_mpuio_driver) == 0)
		(void) platform_device_register(&omap_mpuio_device);
}

900
/*---------------------------------------------------------------------*/
901

D
David Brownell 已提交
902 903 904 905 906 907 908 909 910 911 912 913 914 915
static int gpio_input(struct gpio_chip *chip, unsigned offset)
{
	struct gpio_bank *bank;
	unsigned long flags;

	bank = container_of(chip, struct gpio_bank, chip);
	spin_lock_irqsave(&bank->lock, flags);
	_set_gpio_direction(bank, offset, 1);
	spin_unlock_irqrestore(&bank->lock, flags);
	return 0;
}

static int gpio_get(struct gpio_chip *chip, unsigned offset)
{
916 917 918
	struct gpio_bank *bank;
	u32 mask;

C
Charulatha V 已提交
919
	bank = container_of(chip, struct gpio_bank, chip);
920
	mask = (1 << offset);
921 922

	if (gpio_is_input(bank, mask))
923
		return _get_gpio_datain(bank, offset);
924
	else
925
		return _get_gpio_dataout(bank, offset);
D
David Brownell 已提交
926 927 928 929 930 931 932 933 934
}

static int gpio_output(struct gpio_chip *chip, unsigned offset, int value)
{
	struct gpio_bank *bank;
	unsigned long flags;

	bank = container_of(chip, struct gpio_bank, chip);
	spin_lock_irqsave(&bank->lock, flags);
935
	bank->set_dataout(bank, offset, value);
D
David Brownell 已提交
936 937 938 939 940
	_set_gpio_direction(bank, offset, 0);
	spin_unlock_irqrestore(&bank->lock, flags);
	return 0;
}

941 942 943 944 945 946 947
static int gpio_debounce(struct gpio_chip *chip, unsigned offset,
		unsigned debounce)
{
	struct gpio_bank *bank;
	unsigned long flags;

	bank = container_of(chip, struct gpio_bank, chip);
948

949 950 951 952 953 954 955
	spin_lock_irqsave(&bank->lock, flags);
	_set_gpio_debounce(bank, offset, debounce);
	spin_unlock_irqrestore(&bank->lock, flags);

	return 0;
}

D
David Brownell 已提交
956 957 958 959 960 961 962
static void gpio_set(struct gpio_chip *chip, unsigned offset, int value)
{
	struct gpio_bank *bank;
	unsigned long flags;

	bank = container_of(chip, struct gpio_bank, chip);
	spin_lock_irqsave(&bank->lock, flags);
963
	bank->set_dataout(bank, offset, value);
D
David Brownell 已提交
964 965 966 967 968
	spin_unlock_irqrestore(&bank->lock, flags);
}

/*---------------------------------------------------------------------*/

969
static void __init omap_gpio_show_rev(struct gpio_bank *bank)
T
Tony Lindgren 已提交
970
{
971
	static bool called;
T
Tony Lindgren 已提交
972 973
	u32 rev;

974
	if (called || bank->regs->revision == USHRT_MAX)
T
Tony Lindgren 已提交
975 976
		return;

977 978
	rev = __raw_readw(bank->base + bank->regs->revision);
	pr_info("OMAP GPIO hardware version %d.%d\n",
T
Tony Lindgren 已提交
979
		(rev >> 4) & 0x0f, rev & 0x0f);
980 981

	called = true;
T
Tony Lindgren 已提交
982 983
}

984 985 986 987 988
/* This lock class tells lockdep that GPIO irqs are in a different
 * category than their parents, so it won't report false recursion.
 */
static struct lock_class_key gpio_lock_class;

989
static void omap_gpio_mod_init(struct gpio_bank *bank)
990
{
991 992
	void __iomem *base = bank->base;
	u32 l = 0xffffffff;
993

994 995 996
	if (bank->width == 16)
		l = 0xffff;

997
	if (bank->is_mpuio) {
998 999
		__raw_writel(l, bank->base + bank->regs->irqenable);
		return;
1000
	}
1001 1002

	_gpio_rmw(base, bank->regs->irqenable, l, bank->regs->irqenable_inv);
1003
	_gpio_rmw(base, bank->regs->irqstatus, l, !bank->regs->irqenable_inv);
1004
	if (bank->regs->debounce_en)
1005
		__raw_writel(0, base + bank->regs->debounce_en);
1006

1007 1008
	/* Save OE default value (0xffffffff) in the context */
	bank->context.oe = __raw_readl(bank->base + bank->regs->direction);
1009 1010
	 /* Initialize interface clk ungated, module enabled */
	if (bank->regs->ctrl)
1011
		__raw_writel(0, base + bank->regs->ctrl);
1012 1013 1014 1015

	bank->dbck = clk_get(bank->dev, "dbclk");
	if (IS_ERR(bank->dbck))
		dev_err(bank->dev, "Could not get gpio dbck\n");
1016 1017
}

B
Bill Pemberton 已提交
1018
static void
1019 1020 1021 1022 1023 1024 1025 1026
omap_mpuio_alloc_gc(struct gpio_bank *bank, unsigned int irq_start,
		    unsigned int num)
{
	struct irq_chip_generic *gc;
	struct irq_chip_type *ct;

	gc = irq_alloc_generic_chip("MPUIO", 1, irq_start, bank->base,
				    handle_simple_irq);
1027 1028 1029 1030 1031
	if (!gc) {
		dev_err(bank->dev, "Memory alloc failed for gc\n");
		return;
	}

1032 1033 1034 1035 1036 1037
	ct = gc->chip_types;

	/* NOTE: No ack required, reading IRQ status clears it. */
	ct->chip.irq_mask = irq_gc_mask_set_bit;
	ct->chip.irq_unmask = irq_gc_mask_clr_bit;
	ct->chip.irq_set_type = gpio_irq_type;
1038 1039

	if (bank->regs->wkup_en)
1040
		ct->chip.irq_set_wake = gpio_wake_enable;
1041 1042 1043 1044 1045 1046

	ct->regs.mask = OMAP_MPUIO_GPIO_INT / bank->stride;
	irq_setup_generic_chip(gc, IRQ_MSK(num), IRQ_GC_INIT_MASK_CACHE,
			       IRQ_NOREQUEST | IRQ_NOPROBE, 0);
}

B
Bill Pemberton 已提交
1047
static void omap_gpio_chip_init(struct gpio_bank *bank)
1048
{
1049
	int j;
1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062
	static int gpio;

	/*
	 * REVISIT eventually switch from OMAP-specific gpio structs
	 * over to the generic ones
	 */
	bank->chip.request = omap_gpio_request;
	bank->chip.free = omap_gpio_free;
	bank->chip.direction_input = gpio_input;
	bank->chip.get = gpio_get;
	bank->chip.direction_output = gpio_output;
	bank->chip.set_debounce = gpio_debounce;
	bank->chip.set = gpio_set;
1063
	bank->chip.to_irq = omap_gpio_to_irq;
1064
	if (bank->is_mpuio) {
1065
		bank->chip.label = "mpuio";
1066 1067
		if (bank->regs->wkup_en)
			bank->chip.dev = &omap_mpuio_device.dev;
1068 1069 1070 1071
		bank->chip.base = OMAP_MPUIO(0);
	} else {
		bank->chip.label = "gpio";
		bank->chip.base = gpio;
1072
		gpio += bank->width;
1073
	}
1074
	bank->chip.ngpio = bank->width;
1075 1076 1077

	gpiochip_add(&bank->chip);

1078 1079 1080 1081
	for (j = 0; j < bank->width; j++) {
		int irq = irq_create_mapping(bank->domain, j);
		irq_set_lockdep_class(irq, &gpio_lock_class);
		irq_set_chip_data(irq, bank);
1082
		if (bank->is_mpuio) {
1083
			omap_mpuio_alloc_gc(bank, irq, bank->width);
1084
		} else {
1085 1086 1087
			irq_set_chip_and_handler(irq, &gpio_irq_chip,
						 handle_simple_irq);
			set_irq_flags(irq, IRQF_VALID);
1088
		}
1089
	}
T
Thomas Gleixner 已提交
1090 1091
	irq_set_chained_handler(bank->irq, gpio_irq_handler);
	irq_set_handler_data(bank->irq, bank);
1092 1093
}

1094 1095
static const struct of_device_id omap_gpio_match[];

B
Bill Pemberton 已提交
1096
static int omap_gpio_probe(struct platform_device *pdev)
1097
{
1098
	struct device *dev = &pdev->dev;
1099 1100
	struct device_node *node = dev->of_node;
	const struct of_device_id *match;
1101
	const struct omap_gpio_platform_data *pdata;
1102
	struct resource *res;
1103
	struct gpio_bank *bank;
1104 1105 1106
#ifdef CONFIG_ARCH_OMAP1
	int irq_base;
#endif
1107

1108 1109
	match = of_match_device(of_match_ptr(omap_gpio_match), dev);

J
Jingoo Han 已提交
1110
	pdata = match ? match->data : dev_get_platdata(dev);
1111
	if (!pdata)
1112
		return -EINVAL;
1113

1114
	bank = devm_kzalloc(dev, sizeof(struct gpio_bank), GFP_KERNEL);
1115
	if (!bank) {
1116
		dev_err(dev, "Memory alloc failed\n");
1117
		return -ENOMEM;
1118
	}
1119

1120 1121
	res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
	if (unlikely(!res)) {
1122
		dev_err(dev, "Invalid IRQ resource\n");
1123
		return -ENODEV;
1124
	}
1125

1126
	bank->irq = res->start;
1127
	bank->dev = dev;
1128
	bank->dbck_flag = pdata->dbck_flag;
1129
	bank->stride = pdata->bank_stride;
1130
	bank->width = pdata->bank_width;
1131
	bank->is_mpuio = pdata->is_mpuio;
1132
	bank->non_wakeup_gpios = pdata->non_wakeup_gpios;
1133
	bank->regs = pdata->regs;
1134 1135 1136
#ifdef CONFIG_OF_GPIO
	bank->chip.of_node = of_node_get(node);
#endif
1137 1138 1139 1140 1141
	if (node) {
		if (!of_property_read_bool(node, "ti,gpio-always-on"))
			bank->loses_context = true;
	} else {
		bank->loses_context = pdata->loses_context;
1142 1143 1144 1145

		if (bank->loses_context)
			bank->get_context_loss_count =
				pdata->get_context_loss_count;
1146 1147
	}

1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158
#ifdef CONFIG_ARCH_OMAP1
	/*
	 * REVISIT: Once we have OMAP1 supporting SPARSE_IRQ, we can drop
	 * irq_alloc_descs() and irq_domain_add_legacy() and just use a
	 * linear IRQ domain mapping for all OMAP platforms.
	 */
	irq_base = irq_alloc_descs(-1, 0, bank->width, 0);
	if (irq_base < 0) {
		dev_err(dev, "Couldn't allocate IRQ numbers\n");
		return -ENODEV;
	}
1159

1160 1161 1162
	bank->domain = irq_domain_add_legacy(node, bank->width, irq_base,
					     0, &irq_domain_simple_ops, NULL);
#else
1163 1164
	bank->domain = irq_domain_add_linear(node, bank->width,
					     &irq_domain_simple_ops, NULL);
1165 1166 1167
#endif
	if (!bank->domain) {
		dev_err(dev, "Couldn't register an IRQ domain\n");
1168
		return -ENODEV;
1169
	}
1170 1171 1172 1173 1174

	if (bank->regs->set_dataout && bank->regs->clr_dataout)
		bank->set_dataout = _set_gpio_dataout_reg;
	else
		bank->set_dataout = _set_gpio_dataout_mask;
T
Tony Lindgren 已提交
1175

1176
	spin_lock_init(&bank->lock);
T
Tony Lindgren 已提交
1177

1178 1179 1180
	/* Static mapping, never released */
	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (unlikely(!res)) {
1181
		dev_err(dev, "Invalid mem resource\n");
1182
		irq_domain_remove(bank->domain);
1183 1184 1185 1186 1187 1188
		return -ENODEV;
	}

	if (!devm_request_mem_region(dev, res->start, resource_size(res),
				     pdev->name)) {
		dev_err(dev, "Region already claimed\n");
1189
		irq_domain_remove(bank->domain);
1190
		return -EBUSY;
1191
	}
1192

1193
	bank->base = devm_ioremap(dev, res->start, resource_size(res));
1194
	if (!bank->base) {
1195
		dev_err(dev, "Could not ioremap\n");
1196
		irq_domain_remove(bank->domain);
1197
		return -ENOMEM;
1198 1199
	}

1200 1201
	platform_set_drvdata(pdev, bank);

1202
	pm_runtime_enable(bank->dev);
1203
	pm_runtime_irq_safe(bank->dev);
1204 1205
	pm_runtime_get_sync(bank->dev);

1206
	if (bank->is_mpuio)
1207 1208
		mpuio_init(bank);

1209
	omap_gpio_mod_init(bank);
1210
	omap_gpio_chip_init(bank);
1211
	omap_gpio_show_rev(bank);
T
Tony Lindgren 已提交
1212

1213 1214
	pm_runtime_put(bank->dev);

1215
	list_add_tail(&bank->node, &omap_gpio_list);
1216

1217
	return 0;
1218 1219
}

1220 1221
#ifdef CONFIG_ARCH_OMAP2PLUS

1222
#if defined(CONFIG_PM_RUNTIME)
1223
static void omap_gpio_restore_context(struct gpio_bank *bank);
1224

1225
static int omap_gpio_runtime_suspend(struct device *dev)
1226
{
1227 1228 1229 1230
	struct platform_device *pdev = to_platform_device(dev);
	struct gpio_bank *bank = platform_get_drvdata(pdev);
	u32 l1 = 0, l2 = 0;
	unsigned long flags;
1231
	u32 wake_low, wake_hi;
1232

1233
	spin_lock_irqsave(&bank->lock, flags);
1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254

	/*
	 * Only edges can generate a wakeup event to the PRCM.
	 *
	 * Therefore, ensure any wake-up capable GPIOs have
	 * edge-detection enabled before going idle to ensure a wakeup
	 * to the PRCM is generated on a GPIO transition. (c.f. 34xx
	 * NDA TRM 25.5.3.1)
	 *
	 * The normal values will be restored upon ->runtime_resume()
	 * by writing back the values saved in bank->context.
	 */
	wake_low = bank->context.leveldetect0 & bank->context.wake_en;
	if (wake_low)
		__raw_writel(wake_low | bank->context.fallingdetect,
			     bank->base + bank->regs->fallingdetect);
	wake_hi = bank->context.leveldetect1 & bank->context.wake_en;
	if (wake_hi)
		__raw_writel(wake_hi | bank->context.risingdetect,
			     bank->base + bank->regs->risingdetect);

1255 1256 1257
	if (!bank->enabled_non_wakeup_gpios)
		goto update_gpio_context_count;

1258 1259
	if (bank->power_mode != OFF_MODE) {
		bank->power_mode = 0;
1260
		goto update_gpio_context_count;
1261 1262 1263 1264 1265 1266 1267 1268
	}
	/*
	 * If going to OFF, remove triggering for all
	 * non-wakeup GPIOs.  Otherwise spurious IRQs will be
	 * generated.  See OMAP2420 Errata item 1.101.
	 */
	bank->saved_datain = __raw_readl(bank->base +
						bank->regs->datain);
1269 1270
	l1 = bank->context.fallingdetect;
	l2 = bank->context.risingdetect;
1271

1272 1273
	l1 &= ~bank->enabled_non_wakeup_gpios;
	l2 &= ~bank->enabled_non_wakeup_gpios;
1274

1275 1276
	__raw_writel(l1, bank->base + bank->regs->fallingdetect);
	__raw_writel(l2, bank->base + bank->regs->risingdetect);
1277

1278
	bank->workaround_enabled = true;
1279

1280
update_gpio_context_count:
1281 1282
	if (bank->get_context_loss_count)
		bank->context_loss_count =
1283 1284
				bank->get_context_loss_count(bank->dev);

1285
	_gpio_dbck_disable(bank);
1286
	spin_unlock_irqrestore(&bank->lock, flags);
1287

1288
	return 0;
1289 1290
}

1291 1292
static void omap_gpio_init_context(struct gpio_bank *p);

1293
static int omap_gpio_runtime_resume(struct device *dev)
1294
{
1295 1296 1297 1298
	struct platform_device *pdev = to_platform_device(dev);
	struct gpio_bank *bank = platform_get_drvdata(pdev);
	u32 l = 0, gen, gen0, gen1;
	unsigned long flags;
1299
	int c;
1300

1301
	spin_lock_irqsave(&bank->lock, flags);
1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315

	/*
	 * On the first resume during the probe, the context has not
	 * been initialised and so initialise it now. Also initialise
	 * the context loss count.
	 */
	if (bank->loses_context && !bank->context_valid) {
		omap_gpio_init_context(bank);

		if (bank->get_context_loss_count)
			bank->context_loss_count =
				bank->get_context_loss_count(bank->dev);
	}

1316
	_gpio_dbck_enable(bank);
1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328

	/*
	 * In ->runtime_suspend(), level-triggered, wakeup-enabled
	 * GPIOs were set to edge trigger also in order to be able to
	 * generate a PRCM wakeup.  Here we restore the
	 * pre-runtime_suspend() values for edge triggering.
	 */
	__raw_writel(bank->context.fallingdetect,
		     bank->base + bank->regs->fallingdetect);
	__raw_writel(bank->context.risingdetect,
		     bank->base + bank->regs->risingdetect);

1329 1330
	if (bank->loses_context) {
		if (!bank->get_context_loss_count) {
1331 1332
			omap_gpio_restore_context(bank);
		} else {
1333 1334 1335 1336 1337 1338 1339
			c = bank->get_context_loss_count(bank->dev);
			if (c != bank->context_loss_count) {
				omap_gpio_restore_context(bank);
			} else {
				spin_unlock_irqrestore(&bank->lock, flags);
				return 0;
			}
1340
		}
1341
	}
1342

1343 1344 1345 1346 1347
	if (!bank->workaround_enabled) {
		spin_unlock_irqrestore(&bank->lock, flags);
		return 0;
	}

1348
	l = __raw_readl(bank->base + bank->regs->datain);
1349

1350 1351 1352 1353 1354 1355 1356 1357
	/*
	 * Check if any of the non-wakeup interrupt GPIOs have changed
	 * state.  If so, generate an IRQ by software.  This is
	 * horribly racy, but it's the best we can do to work around
	 * this silicon bug.
	 */
	l ^= bank->saved_datain;
	l &= bank->enabled_non_wakeup_gpios;
1358

1359 1360 1361 1362
	/*
	 * No need to generate IRQs for the rising edge for gpio IRQs
	 * configured with falling edge only; and vice versa.
	 */
1363
	gen0 = l & bank->context.fallingdetect;
1364
	gen0 &= bank->saved_datain;
1365

1366
	gen1 = l & bank->context.risingdetect;
1367
	gen1 &= ~(bank->saved_datain);
1368

1369
	/* FIXME: Consider GPIO IRQs with level detections properly! */
1370 1371
	gen = l & (~(bank->context.fallingdetect) &
					 ~(bank->context.risingdetect));
1372 1373
	/* Consider all GPIO IRQs needed to be updated */
	gen |= gen0 | gen1;
1374

1375 1376
	if (gen) {
		u32 old0, old1;
1377

1378 1379
		old0 = __raw_readl(bank->base + bank->regs->leveldetect0);
		old1 = __raw_readl(bank->base + bank->regs->leveldetect1);
1380

1381
		if (!bank->regs->irqstatus_raw0) {
1382
			__raw_writel(old0 | gen, bank->base +
1383
						bank->regs->leveldetect0);
1384
			__raw_writel(old1 | gen, bank->base +
1385
						bank->regs->leveldetect1);
1386
		}
1387

1388
		if (bank->regs->irqstatus_raw0) {
1389
			__raw_writel(old0 | l, bank->base +
1390
						bank->regs->leveldetect0);
1391
			__raw_writel(old1 | l, bank->base +
1392
						bank->regs->leveldetect1);
1393
		}
1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409
		__raw_writel(old0, bank->base + bank->regs->leveldetect0);
		__raw_writel(old1, bank->base + bank->regs->leveldetect1);
	}

	bank->workaround_enabled = false;
	spin_unlock_irqrestore(&bank->lock, flags);

	return 0;
}
#endif /* CONFIG_PM_RUNTIME */

void omap2_gpio_prepare_for_idle(int pwr_mode)
{
	struct gpio_bank *bank;

	list_for_each_entry(bank, &omap_gpio_list, node) {
1410
		if (!BANK_USED(bank) || !bank->loses_context)
1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423
			continue;

		bank->power_mode = pwr_mode;

		pm_runtime_put_sync_suspend(bank->dev);
	}
}

void omap2_gpio_resume_after_idle(void)
{
	struct gpio_bank *bank;

	list_for_each_entry(bank, &omap_gpio_list, node) {
1424
		if (!BANK_USED(bank) || !bank->loses_context)
1425 1426 1427
			continue;

		pm_runtime_get_sync(bank->dev);
1428 1429 1430
	}
}

1431
#if defined(CONFIG_PM_RUNTIME)
1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454
static void omap_gpio_init_context(struct gpio_bank *p)
{
	struct omap_gpio_reg_offs *regs = p->regs;
	void __iomem *base = p->base;

	p->context.ctrl		= __raw_readl(base + regs->ctrl);
	p->context.oe		= __raw_readl(base + regs->direction);
	p->context.wake_en	= __raw_readl(base + regs->wkup_en);
	p->context.leveldetect0	= __raw_readl(base + regs->leveldetect0);
	p->context.leveldetect1	= __raw_readl(base + regs->leveldetect1);
	p->context.risingdetect	= __raw_readl(base + regs->risingdetect);
	p->context.fallingdetect = __raw_readl(base + regs->fallingdetect);
	p->context.irqenable1	= __raw_readl(base + regs->irqenable);
	p->context.irqenable2	= __raw_readl(base + regs->irqenable2);

	if (regs->set_dataout && p->regs->clr_dataout)
		p->context.dataout = __raw_readl(base + regs->set_dataout);
	else
		p->context.dataout = __raw_readl(base + regs->dataout);

	p->context_valid = true;
}

1455
static void omap_gpio_restore_context(struct gpio_bank *bank)
1456
{
1457
	__raw_writel(bank->context.wake_en,
1458 1459
				bank->base + bank->regs->wkup_en);
	__raw_writel(bank->context.ctrl, bank->base + bank->regs->ctrl);
1460
	__raw_writel(bank->context.leveldetect0,
1461
				bank->base + bank->regs->leveldetect0);
1462
	__raw_writel(bank->context.leveldetect1,
1463
				bank->base + bank->regs->leveldetect1);
1464
	__raw_writel(bank->context.risingdetect,
1465
				bank->base + bank->regs->risingdetect);
1466
	__raw_writel(bank->context.fallingdetect,
1467
				bank->base + bank->regs->fallingdetect);
1468 1469 1470 1471 1472 1473
	if (bank->regs->set_dataout && bank->regs->clr_dataout)
		__raw_writel(bank->context.dataout,
				bank->base + bank->regs->set_dataout);
	else
		__raw_writel(bank->context.dataout,
				bank->base + bank->regs->dataout);
1474 1475
	__raw_writel(bank->context.oe, bank->base + bank->regs->direction);

1476 1477 1478 1479 1480 1481
	if (bank->dbck_enable_mask) {
		__raw_writel(bank->context.debounce, bank->base +
					bank->regs->debounce);
		__raw_writel(bank->context.debounce_en,
					bank->base + bank->regs->debounce_en);
	}
1482 1483 1484 1485 1486

	__raw_writel(bank->context.irqenable1,
				bank->base + bank->regs->irqenable);
	__raw_writel(bank->context.irqenable2,
				bank->base + bank->regs->irqenable2);
1487
}
1488
#endif /* CONFIG_PM_RUNTIME */
1489
#else
1490 1491
#define omap_gpio_runtime_suspend NULL
#define omap_gpio_runtime_resume NULL
1492
static inline void omap_gpio_init_context(struct gpio_bank *p) {}
1493 1494
#endif

1495
static const struct dev_pm_ops gpio_pm_ops = {
1496 1497
	SET_RUNTIME_PM_OPS(omap_gpio_runtime_suspend, omap_gpio_runtime_resume,
									NULL)
1498 1499
};

1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546
#if defined(CONFIG_OF)
static struct omap_gpio_reg_offs omap2_gpio_regs = {
	.revision =		OMAP24XX_GPIO_REVISION,
	.direction =		OMAP24XX_GPIO_OE,
	.datain =		OMAP24XX_GPIO_DATAIN,
	.dataout =		OMAP24XX_GPIO_DATAOUT,
	.set_dataout =		OMAP24XX_GPIO_SETDATAOUT,
	.clr_dataout =		OMAP24XX_GPIO_CLEARDATAOUT,
	.irqstatus =		OMAP24XX_GPIO_IRQSTATUS1,
	.irqstatus2 =		OMAP24XX_GPIO_IRQSTATUS2,
	.irqenable =		OMAP24XX_GPIO_IRQENABLE1,
	.irqenable2 =		OMAP24XX_GPIO_IRQENABLE2,
	.set_irqenable =	OMAP24XX_GPIO_SETIRQENABLE1,
	.clr_irqenable =	OMAP24XX_GPIO_CLEARIRQENABLE1,
	.debounce =		OMAP24XX_GPIO_DEBOUNCE_VAL,
	.debounce_en =		OMAP24XX_GPIO_DEBOUNCE_EN,
	.ctrl =			OMAP24XX_GPIO_CTRL,
	.wkup_en =		OMAP24XX_GPIO_WAKE_EN,
	.leveldetect0 =		OMAP24XX_GPIO_LEVELDETECT0,
	.leveldetect1 =		OMAP24XX_GPIO_LEVELDETECT1,
	.risingdetect =		OMAP24XX_GPIO_RISINGDETECT,
	.fallingdetect =	OMAP24XX_GPIO_FALLINGDETECT,
};

static struct omap_gpio_reg_offs omap4_gpio_regs = {
	.revision =		OMAP4_GPIO_REVISION,
	.direction =		OMAP4_GPIO_OE,
	.datain =		OMAP4_GPIO_DATAIN,
	.dataout =		OMAP4_GPIO_DATAOUT,
	.set_dataout =		OMAP4_GPIO_SETDATAOUT,
	.clr_dataout =		OMAP4_GPIO_CLEARDATAOUT,
	.irqstatus =		OMAP4_GPIO_IRQSTATUS0,
	.irqstatus2 =		OMAP4_GPIO_IRQSTATUS1,
	.irqenable =		OMAP4_GPIO_IRQSTATUSSET0,
	.irqenable2 =		OMAP4_GPIO_IRQSTATUSSET1,
	.set_irqenable =	OMAP4_GPIO_IRQSTATUSSET0,
	.clr_irqenable =	OMAP4_GPIO_IRQSTATUSCLR0,
	.debounce =		OMAP4_GPIO_DEBOUNCINGTIME,
	.debounce_en =		OMAP4_GPIO_DEBOUNCENABLE,
	.ctrl =			OMAP4_GPIO_CTRL,
	.wkup_en =		OMAP4_GPIO_IRQWAKEN0,
	.leveldetect0 =		OMAP4_GPIO_LEVELDETECT0,
	.leveldetect1 =		OMAP4_GPIO_LEVELDETECT1,
	.risingdetect =		OMAP4_GPIO_RISINGDETECT,
	.fallingdetect =	OMAP4_GPIO_FALLINGDETECT,
};

1547
static const struct omap_gpio_platform_data omap2_pdata = {
1548 1549 1550 1551 1552
	.regs = &omap2_gpio_regs,
	.bank_width = 32,
	.dbck_flag = false,
};

1553
static const struct omap_gpio_platform_data omap3_pdata = {
1554 1555 1556 1557 1558
	.regs = &omap2_gpio_regs,
	.bank_width = 32,
	.dbck_flag = true,
};

1559
static const struct omap_gpio_platform_data omap4_pdata = {
1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582
	.regs = &omap4_gpio_regs,
	.bank_width = 32,
	.dbck_flag = true,
};

static const struct of_device_id omap_gpio_match[] = {
	{
		.compatible = "ti,omap4-gpio",
		.data = &omap4_pdata,
	},
	{
		.compatible = "ti,omap3-gpio",
		.data = &omap3_pdata,
	},
	{
		.compatible = "ti,omap2-gpio",
		.data = &omap2_pdata,
	},
	{ },
};
MODULE_DEVICE_TABLE(of, omap_gpio_match);
#endif

1583 1584 1585 1586
static struct platform_driver omap_gpio_driver = {
	.probe		= omap_gpio_probe,
	.driver		= {
		.name	= "omap_gpio",
1587
		.pm	= &gpio_pm_ops,
1588
		.of_match_table = of_match_ptr(omap_gpio_match),
1589 1590 1591
	},
};

1592
/*
1593 1594 1595
 * gpio driver register needs to be done before
 * machine_init functions access gpio APIs.
 * Hence omap_gpio_drv_reg() is a postcore_initcall.
1596
 */
1597
static int __init omap_gpio_drv_reg(void)
1598
{
1599
	return platform_driver_register(&omap_gpio_driver);
1600
}
1601
postcore_initcall(omap_gpio_drv_reg);