gpio-omap.c 43.2 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
#include <linux/of.h>
#include <linux/of_device.h>
27
#include <linux/gpio.h>
28
#include <linux/bitops.h>
29
#include <linux/platform_data/gpio-omap.h>
30

31 32
#define OFF_MODE	1

33 34
static LIST_HEAD(omap_gpio_list);

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

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

78
	void (*set_dataout)(struct gpio_bank *bank, unsigned gpio, int enable);
79
	int (*get_context_loss_count)(struct device *dev);
80 81

	struct omap_gpio_reg_offs *regs;
82 83
};

84
#define GPIO_MOD_CTRL_BIT	BIT(0)
85

86
#define BANK_USED(bank) (bank->mod_usage || bank->irq_usage)
87
#define LINE_USED(line, offset) (line & (BIT(offset)))
88

89 90
static void omap_gpio_unmask_irq(struct irq_data *d);

91
static inline struct gpio_bank *omap_irq_data_get_bank(struct irq_data *d)
92
{
93 94
	struct gpio_chip *chip = irq_data_get_irq_chip_data(d);
	return container_of(chip, struct gpio_bank, chip);
95 96
}

97 98
static void omap_set_gpio_direction(struct gpio_bank *bank, int gpio,
				    int is_input)
99
{
100
	void __iomem *reg = bank->base;
101 102
	u32 l;

103
	reg += bank->regs->direction;
104
	l = readl_relaxed(reg);
105
	if (is_input)
106
		l |= BIT(gpio);
107
	else
108
		l &= ~(BIT(gpio));
109
	writel_relaxed(l, reg);
110
	bank->context.oe = l;
111 112
}

113 114

/* set data out value using dedicate set/clear register */
115
static void omap_set_gpio_dataout_reg(struct gpio_bank *bank, unsigned offset,
116
				      int enable)
117
{
118
	void __iomem *reg = bank->base;
119
	u32 l = BIT(offset);
120

121
	if (enable) {
122
		reg += bank->regs->set_dataout;
123 124
		bank->context.dataout |= l;
	} else {
125
		reg += bank->regs->clr_dataout;
126 127
		bank->context.dataout &= ~l;
	}
128

129
	writel_relaxed(l, reg);
130 131
}

132
/* set data out value using mask register */
133
static void omap_set_gpio_dataout_mask(struct gpio_bank *bank, unsigned offset,
134
				       int enable)
135
{
136
	void __iomem *reg = bank->base + bank->regs->dataout;
137
	u32 gpio_bit = BIT(offset);
138
	u32 l;
139

140
	l = readl_relaxed(reg);
141 142 143 144
	if (enable)
		l |= gpio_bit;
	else
		l &= ~gpio_bit;
145
	writel_relaxed(l, reg);
146
	bank->context.dataout = l;
147 148
}

149
static int omap_get_gpio_datain(struct gpio_bank *bank, int offset)
150
{
151
	void __iomem *reg = bank->base + bank->regs->datain;
152

153
	return (readl_relaxed(reg) & (BIT(offset))) != 0;
154
}
155

156
static int omap_get_gpio_dataout(struct gpio_bank *bank, int offset)
157
{
158
	void __iomem *reg = bank->base + bank->regs->dataout;
159

160
	return (readl_relaxed(reg) & (BIT(offset))) != 0;
161 162
}

163
static inline void omap_gpio_rmw(void __iomem *base, u32 reg, u32 mask, bool set)
164
{
165
	int l = readl_relaxed(base + reg);
166

167
	if (set)
168 169 170 171
		l |= mask;
	else
		l &= ~mask;

172
	writel_relaxed(l, base + reg);
173
}
174

175
static inline void omap_gpio_dbck_enable(struct gpio_bank *bank)
176 177
{
	if (bank->dbck_enable_mask && !bank->dbck_enabled) {
178
		clk_prepare_enable(bank->dbck);
179
		bank->dbck_enabled = true;
180

181
		writel_relaxed(bank->dbck_enable_mask,
182
			     bank->base + bank->regs->debounce_en);
183 184 185
	}
}

186
static inline void omap_gpio_dbck_disable(struct gpio_bank *bank)
187 188
{
	if (bank->dbck_enable_mask && bank->dbck_enabled) {
189 190 191 192 193
		/*
		 * 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.
		 */
194
		writel_relaxed(0, bank->base + bank->regs->debounce_en);
195

196
		clk_disable_unprepare(bank->dbck);
197 198 199 200
		bank->dbck_enabled = false;
	}
}

201
/**
202
 * omap2_set_gpio_debounce - low level gpio debounce time
203
 * @bank: the gpio bank we're acting upon
204
 * @offset: the gpio number on this @bank
205 206 207 208 209
 * @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.
 */
210
static void omap2_set_gpio_debounce(struct gpio_bank *bank, unsigned offset,
211
				    unsigned debounce)
212
{
213
	void __iomem		*reg;
214 215 216
	u32			val;
	u32			l;

217 218 219
	if (!bank->dbck_flag)
		return;

220 221 222 223 224 225 226
	if (debounce < 32)
		debounce = 0x01;
	else if (debounce > 7936)
		debounce = 0xff;
	else
		debounce = (debounce / 0x1f) - 1;

227
	l = BIT(offset);
228

229
	clk_prepare_enable(bank->dbck);
230
	reg = bank->base + bank->regs->debounce;
231
	writel_relaxed(debounce, reg);
232

233
	reg = bank->base + bank->regs->debounce_en;
234
	val = readl_relaxed(reg);
235

236
	if (debounce)
237
		val |= l;
238
	else
239
		val &= ~l;
240
	bank->dbck_enable_mask = val;
241

242
	writel_relaxed(val, reg);
243
	clk_disable_unprepare(bank->dbck);
244 245 246 247 248 249 250 251
	/*
	 * 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.
	 */
252
	omap_gpio_dbck_enable(bank);
253 254 255 256
	if (bank->dbck_enable_mask) {
		bank->context.debounce = debounce;
		bank->context.debounce_en = val;
	}
257 258
}

259
/**
260
 * omap_clear_gpio_debounce - clear debounce settings for a gpio
261
 * @bank: the gpio bank we're acting upon
262
 * @offset: the gpio number on this @bank
263 264 265 266 267 268
 *
 * 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.
 */
269
static void omap_clear_gpio_debounce(struct gpio_bank *bank, unsigned offset)
270
{
271
	u32 gpio_bit = BIT(offset);
272 273 274 275 276 277 278 279 280

	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;
281
        writel_relaxed(bank->context.debounce_en,
282 283 284 285
		     bank->base + bank->regs->debounce_en);

	if (!bank->dbck_enable_mask) {
		bank->context.debounce = 0;
286
		writel_relaxed(bank->context.debounce, bank->base +
287
			     bank->regs->debounce);
288
		clk_disable_unprepare(bank->dbck);
289 290 291 292
		bank->dbck_enabled = false;
	}
}

293
static inline void omap_set_gpio_trigger(struct gpio_bank *bank, int gpio,
294
						unsigned trigger)
295
{
296
	void __iomem *base = bank->base;
297
	u32 gpio_bit = BIT(gpio);
298

299 300 301 302 303 304 305 306
	omap_gpio_rmw(base, bank->regs->leveldetect0, gpio_bit,
		      trigger & IRQ_TYPE_LEVEL_LOW);
	omap_gpio_rmw(base, bank->regs->leveldetect1, gpio_bit,
		      trigger & IRQ_TYPE_LEVEL_HIGH);
	omap_gpio_rmw(base, bank->regs->risingdetect, gpio_bit,
		      trigger & IRQ_TYPE_EDGE_RISING);
	omap_gpio_rmw(base, bank->regs->fallingdetect, gpio_bit,
		      trigger & IRQ_TYPE_EDGE_FALLING);
307

308
	bank->context.leveldetect0 =
309
			readl_relaxed(bank->base + bank->regs->leveldetect0);
310
	bank->context.leveldetect1 =
311
			readl_relaxed(bank->base + bank->regs->leveldetect1);
312
	bank->context.risingdetect =
313
			readl_relaxed(bank->base + bank->regs->risingdetect);
314
	bank->context.fallingdetect =
315
			readl_relaxed(bank->base + bank->regs->fallingdetect);
316 317

	if (likely(!(bank->non_wakeup_gpios & gpio_bit))) {
318
		omap_gpio_rmw(base, bank->regs->wkup_en, gpio_bit, trigger != 0);
319
		bank->context.wake_en =
320
			readl_relaxed(bank->base + bank->regs->wkup_en);
321
	}
322

323
	/* This part needs to be executed always for OMAP{34xx, 44xx} */
324 325 326 327 328 329 330
	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;
		}

331 332 333 334 335 336 337
		/*
		 * 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)
338 339 340 341
			bank->enabled_non_wakeup_gpios |= gpio_bit;
		else
			bank->enabled_non_wakeup_gpios &= ~gpio_bit;
	}
342

343
exit:
344
	bank->level_mask =
345 346
		readl_relaxed(bank->base + bank->regs->leveldetect0) |
		readl_relaxed(bank->base + bank->regs->leveldetect1);
347 348
}

349
#ifdef CONFIG_ARCH_OMAP1
350 351 352 353
/*
 * 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.
 */
354
static void omap_toggle_gpio_edge_triggering(struct gpio_bank *bank, int gpio)
355 356 357 358
{
	void __iomem *reg = bank->base;
	u32 l = 0;

359
	if (!bank->regs->irqctrl)
360
		return;
361 362

	reg += bank->regs->irqctrl;
363

364
	l = readl_relaxed(reg);
365
	if ((l >> gpio) & 1)
366
		l &= ~(BIT(gpio));
367
	else
368
		l |= BIT(gpio);
369

370
	writel_relaxed(l, reg);
371
}
372
#else
373
static void omap_toggle_gpio_edge_triggering(struct gpio_bank *bank, int gpio) {}
374
#endif
375

376 377
static int omap_set_gpio_triggering(struct gpio_bank *bank, int gpio,
				    unsigned trigger)
378 379
{
	void __iomem *reg = bank->base;
380
	void __iomem *base = bank->base;
381
	u32 l = 0;
382

383
	if (bank->regs->leveldetect0 && bank->regs->wkup_en) {
384
		omap_set_gpio_trigger(bank, gpio, trigger);
385 386 387
	} else if (bank->regs->irqctrl) {
		reg += bank->regs->irqctrl;

388
		l = readl_relaxed(reg);
389
		if ((trigger & IRQ_TYPE_SENSE_MASK) == IRQ_TYPE_EDGE_BOTH)
390
			bank->toggle_mask |= BIT(gpio);
391
		if (trigger & IRQ_TYPE_EDGE_RISING)
392
			l |= BIT(gpio);
393
		else if (trigger & IRQ_TYPE_EDGE_FALLING)
394
			l &= ~(BIT(gpio));
395
		else
396 397
			return -EINVAL;

398
		writel_relaxed(l, reg);
399
	} else if (bank->regs->edgectrl1) {
400
		if (gpio & 0x08)
401
			reg += bank->regs->edgectrl2;
402
		else
403 404
			reg += bank->regs->edgectrl1;

405
		gpio &= 0x07;
406
		l = readl_relaxed(reg);
407
		l &= ~(3 << (gpio << 1));
408
		if (trigger & IRQ_TYPE_EDGE_RISING)
409
			l |= 2 << (gpio << 1);
410
		if (trigger & IRQ_TYPE_EDGE_FALLING)
411
			l |= BIT(gpio << 1);
412 413

		/* Enable wake-up during idle for dynamic tick */
414
		omap_gpio_rmw(base, bank->regs->wkup_en, BIT(gpio), trigger);
415
		bank->context.wake_en =
416 417
			readl_relaxed(bank->base + bank->regs->wkup_en);
		writel_relaxed(l, reg);
418
	}
419
	return 0;
420 421
}

422
static void omap_enable_gpio_module(struct gpio_bank *bank, unsigned offset)
423 424 425 426 427
{
	if (bank->regs->pinctrl) {
		void __iomem *reg = bank->base + bank->regs->pinctrl;

		/* Claim the pin for MPU */
428
		writel_relaxed(readl_relaxed(reg) | (BIT(offset)), reg);
429 430 431 432 433 434
	}

	if (bank->regs->ctrl && !BANK_USED(bank)) {
		void __iomem *reg = bank->base + bank->regs->ctrl;
		u32 ctrl;

435
		ctrl = readl_relaxed(reg);
436 437
		/* Module is enabled, clocks are not gated */
		ctrl &= ~GPIO_MOD_CTRL_BIT;
438
		writel_relaxed(ctrl, reg);
439 440 441 442
		bank->context.ctrl = ctrl;
	}
}

443
static void omap_disable_gpio_module(struct gpio_bank *bank, unsigned offset)
444 445 446 447 448 449 450
{
	void __iomem *base = bank->base;

	if (bank->regs->wkup_en &&
	    !LINE_USED(bank->mod_usage, offset) &&
	    !LINE_USED(bank->irq_usage, offset)) {
		/* Disable wake-up during idle for dynamic tick */
451
		omap_gpio_rmw(base, bank->regs->wkup_en, BIT(offset), 0);
452
		bank->context.wake_en =
453
			readl_relaxed(bank->base + bank->regs->wkup_en);
454 455 456 457 458 459
	}

	if (bank->regs->ctrl && !BANK_USED(bank)) {
		void __iomem *reg = bank->base + bank->regs->ctrl;
		u32 ctrl;

460
		ctrl = readl_relaxed(reg);
461 462
		/* Module is disabled, clocks are gated */
		ctrl |= GPIO_MOD_CTRL_BIT;
463
		writel_relaxed(ctrl, reg);
464 465 466 467
		bank->context.ctrl = ctrl;
	}
}

468
static int omap_gpio_is_input(struct gpio_bank *bank, unsigned offset)
469 470 471
{
	void __iomem *reg = bank->base + bank->regs->direction;

472
	return readl_relaxed(reg) & BIT(offset);
473 474
}

475
static void omap_gpio_init_irq(struct gpio_bank *bank, unsigned offset)
476 477 478 479 480
{
	if (!LINE_USED(bank->mod_usage, offset)) {
		omap_enable_gpio_module(bank, offset);
		omap_set_gpio_direction(bank, offset, 1);
	}
481
	bank->irq_usage |= BIT(offset);
482 483
}

484
static int omap_gpio_irq_type(struct irq_data *d, unsigned type)
485
{
486
	struct gpio_bank *bank = omap_irq_data_get_bank(d);
487
	int retval;
488
	unsigned long flags;
489
	unsigned offset = d->hwirq;
490

491
	if (type & ~IRQ_TYPE_SENSE_MASK)
492
		return -EINVAL;
493

494 495
	if (!bank->regs->leveldetect0 &&
		(type & (IRQ_TYPE_LEVEL_LOW|IRQ_TYPE_LEVEL_HIGH)))
496 497
		return -EINVAL;

498 499 500
	if (!BANK_USED(bank))
		pm_runtime_get_sync(bank->dev);

501
	spin_lock_irqsave(&bank->lock, flags);
502
	retval = omap_set_gpio_triggering(bank, offset, type);
503 504
	if (retval) {
		spin_unlock_irqrestore(&bank->lock, flags);
505
		goto error;
506
	}
507
	omap_gpio_init_irq(bank, offset);
508
	if (!omap_gpio_is_input(bank, offset)) {
509
		spin_unlock_irqrestore(&bank->lock, flags);
510 511
		retval = -EINVAL;
		goto error;
512
	}
513
	spin_unlock_irqrestore(&bank->lock, flags);
514 515

	if (type & (IRQ_TYPE_LEVEL_LOW | IRQ_TYPE_LEVEL_HIGH))
516
		__irq_set_handler_locked(d->irq, handle_level_irq);
517
	else if (type & (IRQ_TYPE_EDGE_FALLING | IRQ_TYPE_EDGE_RISING))
518
		__irq_set_handler_locked(d->irq, handle_edge_irq);
519

520 521 522 523 524
	return 0;

error:
	if (!BANK_USED(bank))
		pm_runtime_put(bank->dev);
525
	return retval;
526 527
}

528
static void omap_clear_gpio_irqbank(struct gpio_bank *bank, int gpio_mask)
529
{
530
	void __iomem *reg = bank->base;
531

532
	reg += bank->regs->irqstatus;
533
	writel_relaxed(gpio_mask, reg);
534 535

	/* Workaround for clearing DSP GPIO interrupts to allow retention */
536 537
	if (bank->regs->irqstatus2) {
		reg = bank->base + bank->regs->irqstatus2;
538
		writel_relaxed(gpio_mask, reg);
539
	}
540 541

	/* Flush posted write for the irq status to avoid spurious interrupts */
542
	readl_relaxed(reg);
543 544
}

545 546
static inline void omap_clear_gpio_irqstatus(struct gpio_bank *bank,
					     unsigned offset)
547
{
548
	omap_clear_gpio_irqbank(bank, BIT(offset));
549 550
}

551
static u32 omap_get_gpio_irqbank_mask(struct gpio_bank *bank)
552 553
{
	void __iomem *reg = bank->base;
554
	u32 l;
555
	u32 mask = (BIT(bank->width)) - 1;
556

557
	reg += bank->regs->irqenable;
558
	l = readl_relaxed(reg);
559
	if (bank->regs->irqenable_inv)
560 561 562
		l = ~l;
	l &= mask;
	return l;
563 564
}

565
static void omap_enable_gpio_irqbank(struct gpio_bank *bank, int gpio_mask)
566
{
567
	void __iomem *reg = bank->base;
568 569
	u32 l;

570 571 572
	if (bank->regs->set_irqenable) {
		reg += bank->regs->set_irqenable;
		l = gpio_mask;
573
		bank->context.irqenable1 |= gpio_mask;
574 575
	} else {
		reg += bank->regs->irqenable;
576
		l = readl_relaxed(reg);
577 578
		if (bank->regs->irqenable_inv)
			l &= ~gpio_mask;
579 580
		else
			l |= gpio_mask;
581
		bank->context.irqenable1 = l;
582 583
	}

584
	writel_relaxed(l, reg);
585 586
}

587
static void omap_disable_gpio_irqbank(struct gpio_bank *bank, int gpio_mask)
588 589 590 591 592 593
{
	void __iomem *reg = bank->base;
	u32 l;

	if (bank->regs->clr_irqenable) {
		reg += bank->regs->clr_irqenable;
594
		l = gpio_mask;
595
		bank->context.irqenable1 &= ~gpio_mask;
596 597
	} else {
		reg += bank->regs->irqenable;
598
		l = readl_relaxed(reg);
599
		if (bank->regs->irqenable_inv)
600
			l |= gpio_mask;
601
		else
602
			l &= ~gpio_mask;
603
		bank->context.irqenable1 = l;
604
	}
605

606
	writel_relaxed(l, reg);
607 608
}

609 610
static inline void omap_set_gpio_irqenable(struct gpio_bank *bank,
					   unsigned offset, int enable)
611
{
612
	if (enable)
613
		omap_enable_gpio_irqbank(bank, BIT(offset));
614
	else
615
		omap_disable_gpio_irqbank(bank, BIT(offset));
616 617
}

618 619 620 621 622 623 624 625
/*
 * 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.
 */
626 627
static int omap_set_gpio_wakeup(struct gpio_bank *bank, unsigned offset,
				int enable)
628
{
629
	u32 gpio_bit = BIT(offset);
630
	unsigned long flags;
631

632
	if (bank->non_wakeup_gpios & gpio_bit) {
633
		dev_err(bank->dev,
634 635
			"Unable to modify wakeup on non-wakeup GPIO%d\n",
			offset);
636 637
		return -EINVAL;
	}
638 639 640

	spin_lock_irqsave(&bank->lock, flags);
	if (enable)
641
		bank->context.wake_en |= gpio_bit;
642
	else
643
		bank->context.wake_en &= ~gpio_bit;
644

645
	writel_relaxed(bank->context.wake_en, bank->base + bank->regs->wkup_en);
646 647 648
	spin_unlock_irqrestore(&bank->lock, flags);

	return 0;
649 650 651
}

/* Use disable_irq_wake() and enable_irq_wake() functions from drivers */
652
static int omap_gpio_wake_enable(struct irq_data *d, unsigned int enable)
653
{
654
	struct gpio_bank *bank = omap_irq_data_get_bank(d);
655
	unsigned offset = d->hwirq;
656

657
	return omap_set_gpio_wakeup(bank, offset, enable);
658 659
}

660
static int omap_gpio_request(struct gpio_chip *chip, unsigned offset)
661
{
662
	struct gpio_bank *bank = container_of(chip, struct gpio_bank, chip);
663
	unsigned long flags;
David Brownell's avatar
David Brownell committed
664

665 666 667 668
	/*
	 * If this is the first gpio_request for the bank,
	 * enable the bank module.
	 */
669
	if (!BANK_USED(bank))
670
		pm_runtime_get_sync(bank->dev);
671

672
	spin_lock_irqsave(&bank->lock, flags);
673
	omap_enable_gpio_module(bank, offset);
674
	bank->mod_usage |= BIT(offset);
675
	spin_unlock_irqrestore(&bank->lock, flags);
676 677 678 679

	return 0;
}

680
static void omap_gpio_free(struct gpio_chip *chip, unsigned offset)
681
{
682
	struct gpio_bank *bank = container_of(chip, struct gpio_bank, chip);
683
	unsigned long flags;
684

685
	spin_lock_irqsave(&bank->lock, flags);
686
	bank->mod_usage &= ~(BIT(offset));
687 688 689 690
	if (!LINE_USED(bank->irq_usage, offset)) {
		omap_set_gpio_direction(bank, offset, 1);
		omap_clear_gpio_debounce(bank, offset);
	}
691
	omap_disable_gpio_module(bank, offset);
692
	spin_unlock_irqrestore(&bank->lock, flags);
693 694 695 696 697

	/*
	 * If this is the last gpio to be freed in the bank,
	 * disable the bank module.
	 */
698
	if (!BANK_USED(bank))
699
		pm_runtime_put(bank->dev);
700 701 702 703 704 705 706 707 708 709 710
}

/*
 * 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.
 */
711
static void omap_gpio_irq_handler(unsigned int irq, struct irq_desc *desc)
712
{
713
	void __iomem *isr_reg = NULL;
714
	u32 isr;
715
	unsigned int bit;
716
	struct gpio_bank *bank;
717
	int unmasked = 0;
718 719
	struct irq_chip *irqchip = irq_desc_get_chip(desc);
	struct gpio_chip *chip = irq_get_handler_data(irq);
720

721
	chained_irq_enter(irqchip, desc);
722

723
	bank = container_of(chip, struct gpio_bank, chip);
724
	isr_reg = bank->base + bank->regs->irqstatus;
725
	pm_runtime_get_sync(bank->dev);
726 727 728 729

	if (WARN_ON(!isr_reg))
		goto exit;

730
	while (1) {
731
		u32 isr_saved, level_mask = 0;
732
		u32 enabled;
733

734
		enabled = omap_get_gpio_irqbank_mask(bank);
735
		isr_saved = isr = readl_relaxed(isr_reg) & enabled;
736

737
		if (bank->level_mask)
738
			level_mask = bank->level_mask & enabled;
739 740 741 742

		/* clear edge sensitive interrupts before handler(s) are
		called so that we don't miss any interrupt occurred while
		executing them */
743 744 745
		omap_disable_gpio_irqbank(bank, isr_saved & ~level_mask);
		omap_clear_gpio_irqbank(bank, isr_saved & ~level_mask);
		omap_enable_gpio_irqbank(bank, isr_saved & ~level_mask);
746 747 748

		/* if there is only edge sensitive GPIO pin interrupts
		configured, we could unmask GPIO bank interrupt immediately */
749 750
		if (!level_mask && !unmasked) {
			unmasked = 1;
751
			chained_irq_exit(irqchip, desc);
752
		}
753 754 755 756

		if (!isr)
			break;

757 758
		while (isr) {
			bit = __ffs(isr);
759
			isr &= ~(BIT(bit));
760

761 762 763 764 765 766 767
			/*
			 * 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.
			 */
768
			if (bank->toggle_mask & (BIT(bit)))
769
				omap_toggle_gpio_edge_triggering(bank, bit);
770

771 772
			generic_handle_irq(irq_find_mapping(bank->chip.irqdomain,
							    bit));
773
		}
774
	}
775 776 777 778
	/* 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 */
779
exit:
780
	if (!unmasked)
781
		chained_irq_exit(irqchip, desc);
782
	pm_runtime_put(bank->dev);
783 784
}

785 786 787 788
static unsigned int omap_gpio_irq_startup(struct irq_data *d)
{
	struct gpio_bank *bank = omap_irq_data_get_bank(d);
	unsigned long flags;
789
	unsigned offset = d->hwirq;
790 791 792 793 794

	if (!BANK_USED(bank))
		pm_runtime_get_sync(bank->dev);

	spin_lock_irqsave(&bank->lock, flags);
795 796 797 798 799 800 801 802

	if (!LINE_USED(bank->mod_usage, offset))
		omap_set_gpio_direction(bank, offset, 1);
	else if (!omap_gpio_is_input(bank, offset))
		goto err;
	omap_enable_gpio_module(bank, offset);
	bank->irq_usage |= BIT(offset);

803 804 805 806
	spin_unlock_irqrestore(&bank->lock, flags);
	omap_gpio_unmask_irq(d);

	return 0;
807 808 809 810 811
err:
	spin_unlock_irqrestore(&bank->lock, flags);
	if (!BANK_USED(bank))
		pm_runtime_put(bank->dev);
	return -EINVAL;
812 813
}

814
static void omap_gpio_irq_shutdown(struct irq_data *d)
815
{
816
	struct gpio_bank *bank = omap_irq_data_get_bank(d);
817
	unsigned long flags;
818
	unsigned offset = d->hwirq;
819

820
	spin_lock_irqsave(&bank->lock, flags);
821
	bank->irq_usage &= ~(BIT(offset));
822 823 824 825 826
	omap_set_gpio_irqenable(bank, offset, 0);
	omap_clear_gpio_irqstatus(bank, offset);
	omap_set_gpio_triggering(bank, offset, IRQ_TYPE_NONE);
	if (!LINE_USED(bank->mod_usage, offset))
		omap_clear_gpio_debounce(bank, offset);
827
	omap_disable_gpio_module(bank, offset);
828
	spin_unlock_irqrestore(&bank->lock, flags);
829 830 831 832 833 834 835

	/*
	 * If this is the last IRQ to be freed in the bank,
	 * disable the bank module.
	 */
	if (!BANK_USED(bank))
		pm_runtime_put(bank->dev);
836 837
}

838
static void omap_gpio_ack_irq(struct irq_data *d)
839
{
840
	struct gpio_bank *bank = omap_irq_data_get_bank(d);
841
	unsigned offset = d->hwirq;
842

843
	omap_clear_gpio_irqstatus(bank, offset);
844 845
}

846
static void omap_gpio_mask_irq(struct irq_data *d)
847
{
848
	struct gpio_bank *bank = omap_irq_data_get_bank(d);
849
	unsigned offset = d->hwirq;
850
	unsigned long flags;
851

852
	spin_lock_irqsave(&bank->lock, flags);
853 854
	omap_set_gpio_irqenable(bank, offset, 0);
	omap_set_gpio_triggering(bank, offset, IRQ_TYPE_NONE);
855
	spin_unlock_irqrestore(&bank->lock, flags);
856 857
}

858
static void omap_gpio_unmask_irq(struct irq_data *d)
859
{
860
	struct gpio_bank *bank = omap_irq_data_get_bank(d);
861
	unsigned offset = d->hwirq;
862
	u32 trigger = irqd_get_trigger_type(d);
863
	unsigned long flags;
864

865
	spin_lock_irqsave(&bank->lock, flags);
866
	if (trigger)
867
		omap_set_gpio_triggering(bank, offset, trigger);
868 869 870

	/* For level-triggered GPIOs, the clearing must be done after
	 * the HW source is cleared, thus after the handler has run */
871 872 873
	if (bank->level_mask & BIT(offset)) {
		omap_set_gpio_irqenable(bank, offset, 0);
		omap_clear_gpio_irqstatus(bank, offset);
874
	}
875

876
	omap_set_gpio_irqenable(bank, offset, 1);
877
	spin_unlock_irqrestore(&bank->lock, flags);
878 879
}

880 881
/*---------------------------------------------------------------------*/

882
static int omap_mpuio_suspend_noirq(struct device *dev)
883
{
884
	struct platform_device *pdev = to_platform_device(dev);
885
	struct gpio_bank	*bank = platform_get_drvdata(pdev);
886 887
	void __iomem		*mask_reg = bank->base +
					OMAP_MPUIO_GPIO_MASKIT / bank->stride;
888
	unsigned long		flags;
889

890
	spin_lock_irqsave(&bank->lock, flags);
891
	writel_relaxed(0xffff & ~bank->context.wake_en, mask_reg);
892
	spin_unlock_irqrestore(&bank->lock, flags);
893 894 895 896

	return 0;
}

897
static int omap_mpuio_resume_noirq(struct device *dev)
898
{
899
	struct platform_device *pdev = to_platform_device(dev);
900
	struct gpio_bank	*bank = platform_get_drvdata(pdev);
901 902
	void __iomem		*mask_reg = bank->base +
					OMAP_MPUIO_GPIO_MASKIT / bank->stride;
903
	unsigned long		flags;
904

905
	spin_lock_irqsave(&bank->lock, flags);
906
	writel_relaxed(bank->context.wake_en, mask_reg);
907
	spin_unlock_irqrestore(&bank->lock, flags);
908 909 910 911

	return 0;
}

912
static const struct dev_pm_ops omap_mpuio_dev_pm_ops = {
913 914 915 916
	.suspend_noirq = omap_mpuio_suspend_noirq,
	.resume_noirq = omap_mpuio_resume_noirq,
};

917
/* use platform_driver for this. */
918 919 920
static struct platform_driver omap_mpuio_driver = {
	.driver		= {
		.name	= "mpuio",
921
		.pm	= &omap_mpuio_dev_pm_ops,
922 923 924 925 926 927 928 929 930 931 932 933
	},
};

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

934
static inline void omap_mpuio_init(struct gpio_bank *bank)
935
{
936
	platform_set_drvdata(&omap_mpuio_device, bank);
937

938 939 940 941
	if (platform_driver_register(&omap_mpuio_driver) == 0)
		(void) platform_device_register(&omap_mpuio_device);
}

942
/*---------------------------------------------------------------------*/
943

944
static int omap_gpio_get_direction(struct gpio_chip *chip, unsigned offset)
945 946 947 948 949 950 951 952 953 954 955 956 957 958
{
	struct gpio_bank *bank;
	unsigned long flags;
	void __iomem *reg;
	int dir;

	bank = container_of(chip, struct gpio_bank, chip);
	reg = bank->base + bank->regs->direction;
	spin_lock_irqsave(&bank->lock, flags);
	dir = !!(readl_relaxed(reg) & BIT(offset));
	spin_unlock_irqrestore(&bank->lock, flags);
	return dir;
}

959
static int omap_gpio_input(struct gpio_chip *chip, unsigned offset)
David Brownell's avatar
David Brownell committed
960 961 962 963 964 965
{
	struct gpio_bank *bank;
	unsigned long flags;

	bank = container_of(chip, struct gpio_bank, chip);
	spin_lock_irqsave(&bank->lock, flags);
966
	omap_set_gpio_direction(bank, offset, 1);
David Brownell's avatar
David Brownell committed
967 968 969 970
	spin_unlock_irqrestore(&bank->lock, flags);
	return 0;
}

971
static int omap_gpio_get(struct gpio_chip *chip, unsigned offset)
David Brownell's avatar
David Brownell committed
972
{
973 974
	struct gpio_bank *bank;

975
	bank = container_of(chip, struct gpio_bank, chip);
976

977
	if (omap_gpio_is_input(bank, offset))
978
		return omap_get_gpio_datain(bank, offset);
979
	else
980
		return omap_get_gpio_dataout(bank, offset);
David Brownell's avatar
David Brownell committed
981 982
}

983
static int omap_gpio_output(struct gpio_chip *chip, unsigned offset, int value)
David Brownell's avatar
David Brownell committed
984 985 986 987 988 989
{
	struct gpio_bank *bank;
	unsigned long flags;

	bank = container_of(chip, struct gpio_bank, chip);
	spin_lock_irqsave(&bank->lock, flags);
990
	bank->set_dataout(bank, offset, value);
991
	omap_set_gpio_direction(bank, offset, 0);
David Brownell's avatar
David Brownell committed
992
	spin_unlock_irqrestore(&bank->lock, flags);
993
	return 0;
David Brownell's avatar
David Brownell committed
994 995
}

996 997
static int omap_gpio_debounce(struct gpio_chip *chip, unsigned offset,
			      unsigned debounce)
998 999 1000 1001 1002
{
	struct gpio_bank *bank;
	unsigned long flags;

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

1004
	spin_lock_irqsave(&bank->lock, flags);
1005
	omap2_set_gpio_debounce(bank, offset, debounce);
1006 1007 1008 1009 1010
	spin_unlock_irqrestore(&bank->lock, flags);

	return 0;
}

1011
static void omap_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
David Brownell's avatar
David Brownell committed
1012 1013 1014 1015 1016 1017
{
	struct gpio_bank *bank;
	unsigned long flags;

	bank = container_of(chip, struct gpio_bank, chip);
	spin_lock_irqsave(&bank->lock, flags);
1018
	bank->set_dataout(bank, offset, value);
David Brownell's avatar
David Brownell committed
1019 1020 1021 1022 1023
	spin_unlock_irqrestore(&bank->lock, flags);
}

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

1024
static void __init omap_gpio_show_rev(struct gpio_bank *bank)
Tony Lindgren's avatar
Tony Lindgren committed
1025
{
1026
	static bool called;
Tony Lindgren's avatar
Tony Lindgren committed
1027 1028
	u32 rev;

1029
	if (called || bank->regs->revision == USHRT_MAX)
Tony Lindgren's avatar
Tony Lindgren committed
1030 1031
		return;

1032
	rev = readw_relaxed(bank->base + bank->regs->revision);
1033
	pr_info("OMAP GPIO hardware version %d.%d\n",
Tony Lindgren's avatar
Tony Lindgren committed
1034
		(rev >> 4) & 0x0f, rev & 0x0f);
1035 1036

	called = true;
Tony Lindgren's avatar
Tony Lindgren committed
1037 1038
}

1039
static void omap_gpio_mod_init(struct gpio_bank *bank)
1040
{
1041 1042
	void __iomem *base = bank->base;
	u32 l = 0xffffffff;
1043

1044 1045 1046
	if (bank->width == 16)
		l = 0xffff;

1047
	if (bank->is_mpuio) {
1048
		writel_relaxed(l, bank->base + bank->regs->irqenable);
1049
		return;
1050
	}
1051

1052 1053 1054 1055
	omap_gpio_rmw(base, bank->regs->irqenable, l,
		      bank->regs->irqenable_inv);
	omap_gpio_rmw(base, bank->regs->irqstatus, l,
		      !bank->regs->irqenable_inv);
1056
	if (bank->regs->debounce_en)
1057
		writel_relaxed(0, base + bank->regs->debounce_en);
1058

1059
	/* Save OE default value (0xffffffff) in the context */
1060
	bank->context.oe = readl_relaxed(bank->base + bank->regs->direction);
1061 1062
	 /* Initialize interface clk ungated, module enabled */
	if (bank->regs->ctrl)
1063
		writel_relaxed(0, base + bank->regs->ctrl);
1064 1065 1066 1067

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

1070
static int omap_gpio_chip_init(struct gpio_bank *bank, struct irq_chip *irqc)
1071 1072
{
	static int gpio;
1073
	int irq_base = 0;
1074
	int ret;
1075 1076 1077 1078 1079 1080 1081

	/*
	 * 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;
1082 1083 1084 1085 1086 1087
	bank->chip.get_direction = omap_gpio_get_direction;
	bank->chip.direction_input = omap_gpio_input;
	bank->chip.get = omap_gpio_get;
	bank->chip.direction_output = omap_gpio_output;
	bank->chip.set_debounce = omap_gpio_debounce;
	bank->chip.set = omap_gpio_set;
1088
	if (bank->is_mpuio) {
1089
		bank->chip.label = "mpuio";
1090 1091
		if (bank->regs->wkup_en)
			bank->chip.dev = &omap_mpuio_device.dev;
1092 1093 1094 1095
		bank->chip.base = OMAP_MPUIO(0);
	} else {
		bank->chip.label = "gpio";
		bank->chip.base = gpio;
1096
		gpio += bank->width;
1097
	}
1098
	bank->chip.ngpio = bank->width;
1099

1100 1101
	ret = gpiochip_add(&bank->chip);
	if (ret) {
1102
		dev_err(bank->dev, "Could not register gpio chip %d\n", ret);
1103 1104
		return ret;
	}
1105

1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117
#ifdef CONFIG_ARCH_OMAP1
	/*
	 * REVISIT: Once we have OMAP1 supporting SPARSE_IRQ, we can drop
	 * irq_alloc_descs() since a base IRQ offset will no longer be needed.
	 */
	irq_base = irq_alloc_descs(-1, 0, bank->width, 0);
	if (irq_base < 0) {
		dev_err(bank->dev, "Couldn't allocate IRQ numbers\n");
		return -ENODEV;
	}
#endif

1118 1119 1120 1121 1122 1123 1124 1125 1126
	/* MPUIO is a bit different, reading IRQ status clears it */
	if (bank->is_mpuio) {
		irqc->irq_ack = dummy_irq_chip.irq_ack;
		irqc->irq_mask = irq_gc_mask_set_bit;
		irqc->irq_unmask = irq_gc_mask_clr_bit;
		if (!bank->regs->wkup_en)
			irqc->irq_set_wake = NULL;
	}

1127
	ret = gpiochip_irqchip_add(&bank->chip, irqc,
1128
				   irq_base, omap_gpio_irq_handler,
1129 1130 1131 1132
				   IRQ_TYPE_NONE);

	if (ret) {
		dev_err(bank->dev, "Couldn't add irqchip to gpiochip %d\n", ret);
1133
		gpiochip_remove(&bank->chip);
1134 1135 1136
		return -ENODEV;
	}

1137
	gpiochip_set_chained_irqchip(&bank->chip, irqc,
1138
				     bank->irq, omap_gpio_irq_handler);
1139 1140

	return 0;
1141 1142
}

1143 1144
static const struct of_device_id omap_gpio_match[];

1145
static int omap_gpio_probe(struct platform_device *pdev)
1146
{
1147
	struct device *dev = &pdev->dev;
1148 1149
	struct device_node *node = dev->of_node;
	const struct of_device_id *match;
1150
	const struct omap_gpio_platform_data *pdata;
1151
	struct resource *res;
1152
	struct gpio_bank *bank;
1153
	struct irq_chip *irqc;
1154
	int ret;
1155

1156 1157
	match = of_match_device(of_match_ptr(omap_gpio_match), dev);

Jingoo Han's avatar
Jingoo Han committed
1158
	pdata = match ? match->data : dev_get_platdata(dev);
1159
	if (!pdata)
1160
		return -EINVAL;
1161

1162
	bank = devm_kzalloc(dev, sizeof(struct gpio_bank), GFP_KERNEL);
1163
	if (!bank) {
1164
		dev_err(dev, "Memory alloc failed\n");
1165
		return -ENOMEM;
1166
	}
1167

1168 1169 1170 1171
	irqc = devm_kzalloc(dev, sizeof(*irqc), GFP_KERNEL);
	if (!irqc)
		return -ENOMEM;

1172
	irqc->irq_startup = omap_gpio_irq_startup,
1173 1174 1175 1176 1177 1178 1179 1180
	irqc->irq_shutdown = omap_gpio_irq_shutdown,
	irqc->irq_ack = omap_gpio_ack_irq,
	irqc->irq_mask = omap_gpio_mask_irq,
	irqc->irq_unmask = omap_gpio_unmask_irq,
	irqc->irq_set_type = omap_gpio_irq_type,
	irqc->irq_set_wake = omap_gpio_wake_enable,
	irqc->name = dev_name(&pdev->dev);

1181 1182
	res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
	if (unlikely(!res)) {
1183
		dev_err(dev, "Invalid IRQ resource\n");
1184
		return -ENODEV;
1185
	}
1186

1187
	bank->irq = res->start;
1188
	bank->dev = dev;
1189
	bank->chip.dev = dev;
1190
	bank->chip.owner = THIS_MODULE;
1191
	bank->dbck_flag = pdata->dbck_flag;
1192
	bank->stride = pdata->bank_stride;
1193
	bank->width = pdata->bank_width;
1194
	bank->is_mpuio = pdata->is_mpuio;
1195
	bank->non_wakeup_gpios = pdata->non_wakeup_gpios;
1196
	bank->regs = pdata->regs;
1197 1198 1199
#ifdef CONFIG_OF_GPIO
	bank->chip.of_node = of_node_get(node);
#endif
1200 1201 1202 1203 1204
	if (node) {
		if (!of_property_read_bool(node, "ti,gpio-always-on"))
			bank->loses_context = true;
	} else {
		bank->loses_context = pdata->loses_context;
1205 1206 1207 1208

		if (bank->loses_context)
			bank->get_context_loss_count =
				pdata->get_context_loss_count;
1209 1210
	}

1211
	if (bank->regs->set_dataout && bank->regs->clr_dataout)
1212
		bank->set_dataout = omap_set_gpio_dataout_reg;
1213
	else
1214
		bank->set_dataout = omap_set_gpio_dataout_mask;
Tony Lindgren's avatar
Tony Lindgren committed
1215

1216
	spin_lock_init(&bank->lock);
Tony Lindgren's avatar
Tony Lindgren committed
1217

1218 1219
	/* Static mapping, never released */
	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1220 1221
	bank->base = devm_ioremap_resource(dev, res);
	if (IS_ERR(bank->base)) {
1222
		irq_domain_remove(bank->chip.irqdomain);
1223
		return PTR_ERR(bank->base);
1224 1225
	}

1226 1227
	platform_set_drvdata(pdev, bank);

1228
	pm_runtime_enable(bank->dev);
1229
	pm_runtime_irq_safe(bank->dev);
1230 1231
	pm_runtime_get_sync(bank->dev);

1232
	if (bank->is_mpuio)
1233
		omap_mpuio_init(bank);
1234

1235
	omap_gpio_mod_init(bank);
1236

1237
	ret = omap_gpio_chip_init(bank, irqc);
1238 1239 1240
	if (ret)
		return ret;

1241
	omap_gpio_show_rev(bank);
Tony Lindgren's avatar
Tony Lindgren committed
1242

1243 1244
	pm_runtime_put(bank->dev);

1245
	list_add_tail(&bank->node, &omap_gpio_list);
1246

1247
	return 0;
1248 1249
}

1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260
static int omap_gpio_remove(struct platform_device *pdev)
{
	struct gpio_bank *bank = platform_get_drvdata(pdev);

	list_del(&bank->node);
	gpiochip_remove(&bank->chip);
	pm_runtime_disable(bank->dev);

	return 0;
}

1261 1262
#ifdef CONFIG_ARCH_OMAP2PLUS

1263
#if defined(CONFIG_PM)
1264
static void omap_gpio_restore_context(struct gpio_bank *bank);
1265

1266
static int omap_gpio_runtime_suspend(struct device *dev)
1267
{
1268 1269 1270 1271
	struct platform_device *pdev = to_platform_device(dev);
	struct gpio_bank *bank = platform_get_drvdata(pdev);
	u32 l1 = 0, l2 = 0;
	unsigned long flags;
1272
	u32 wake_low, wake_hi;
1273

1274
	spin_lock_irqsave(&bank->lock, flags);
1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288

	/*
	 * 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)
1289
		writel_relaxed(wake_low | bank->context.fallingdetect,
1290 1291 1292
			     bank->base + bank->regs->fallingdetect);
	wake_hi = bank->context.leveldetect1 & bank->context.wake_en;
	if (wake_hi)
1293
		writel_relaxed(wake_hi | bank->context.risingdetect,
1294 1295
			     bank->base + bank->regs->risingdetect);

1296 1297 1298
	if (!bank->enabled_non_wakeup_gpios)
		goto update_gpio_context_count;

1299 1300
	if (bank->power_mode != OFF_MODE) {
		bank->power_mode = 0;
1301
		goto update_gpio_context_count;
1302 1303 1304 1305 1306 1307
	}
	/*
	 * If going to OFF, remove triggering for all
	 * non-wakeup GPIOs.  Otherwise spurious IRQs will be
	 * generated.  See OMAP2420 Errata item 1.101.
	 */
1308
	bank->saved_datain = readl_relaxed(bank->base +
1309
						bank->regs->datain);
1310 1311
	l1 = bank->context.fallingdetect;
	l2 = bank->context.risingdetect;
1312

1313 1314
	l1 &= ~bank->enabled_non_wakeup_gpios;
	l2 &= ~bank->enabled_non_wakeup_gpios;
1315

1316 1317
	writel_relaxed(l1, bank->base + bank->regs->fallingdetect);
	writel_relaxed(l2, bank->base + bank->regs->risingdetect);
1318

1319
	bank->workaround_enabled = true;
1320

1321
update_gpio_context_count:
1322 1323
	if (bank->get_context_loss_count)
		bank->context_loss_count =
1324 1325
				bank->get_context_loss_count(bank->dev);

1326
	omap_gpio_dbck_disable(bank);
1327
	spin_unlock_irqrestore(&bank->lock, flags);
1328

1329
	return 0;
1330 1331
}

1332 1333
static void omap_gpio_init_context(struct gpio_bank *p);

1334
static int omap_gpio_runtime_resume(struct device *dev)
1335
{
1336 1337 1338 1339
	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;
1340
	int c;
1341

1342
	spin_lock_irqsave(&bank->lock, flags);
1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356

	/*
	 * 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);
	}

1357
	omap_gpio_dbck_enable(bank);
1358 1359 1360 1361 1362 1363 1364

	/*
	 * 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.
	 */
1365
	writel_relaxed(bank->context.fallingdetect,
1366
		     bank->base + bank->regs->fallingdetect);
1367
	writel_relaxed(bank->context.risingdetect,
1368 1369
		     bank->base + bank->regs->risingdetect);

1370 1371
	if (bank->loses_context) {
		if (!bank->get_context_loss_count) {
1372 1373
			omap_gpio_restore_context(bank);
		} else {
1374 1375 1376 1377 1378 1379 1380
			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;
			}
1381
		}
1382
	}
1383

1384 1385 1386 1387 1388
	if (!bank->workaround_enabled) {
		spin_unlock_irqrestore(&bank->lock, flags);
		return 0;
	}

1389
	l = readl_relaxed(bank->base + bank->regs->datain);
1390

1391 1392 1393 1394 1395 1396 1397 1398
	/*
	 * 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;
1399

1400 1401 1402 1403
	/*
	 * No need to generate IRQs for the rising edge for gpio IRQs
	 * configured with falling edge only; and vice versa.
	 */
1404
	gen0 = l & bank->context.fallingdetect;
1405
	gen0 &= bank->saved_datain;
1406

1407
	gen1 = l & bank->context.risingdetect;
1408
	gen1 &= ~(bank->saved_datain);
1409

1410
	/* FIXME: Consider GPIO IRQs with level detections properly! */
1411 1412
	gen = l & (~(bank->context.fallingdetect) &
					 ~(bank->context.risingdetect));
1413 1414
	/* Consider all GPIO IRQs needed to be updated */
	gen |= gen0 | gen1;
1415

1416 1417
	if (gen) {
		u32 old0, old1;
1418

1419 1420
		old0 = readl_relaxed(bank->base + bank->regs->leveldetect0);
		old1 = readl_relaxed(bank->base + bank->regs->leveldetect1);
1421

1422
		if (!bank->regs->irqstatus_raw0) {
1423
			writel_relaxed(old0 | gen, bank->base +
1424
						bank->regs->leveldetect0);
1425
			writel_relaxed(old1 | gen, bank->base +
1426
						bank->regs->leveldetect1);
1427
		}
1428

1429
		if (bank->regs->irqstatus_raw0) {
1430
			writel_relaxed(old0 | l, bank->base +
1431
						bank->regs->leveldetect0);
1432
			writel_relaxed(old1 | l, bank->base +
1433
						bank->regs->leveldetect1);
1434
		}
1435 1436
		writel_relaxed(old0, bank->base + bank->regs->leveldetect0);
		writel_relaxed(old1, bank->base + bank->regs->leveldetect1);
1437 1438 1439 1440 1441 1442 1443
	}

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

	return 0;
}
1444
#endif /* CONFIG_PM */
1445

1446
#if IS_BUILTIN(CONFIG_GPIO_OMAP)
1447 1448 1449 1450 1451
void omap2_gpio_prepare_for_idle(int pwr_mode)
{
	struct gpio_bank *bank;

	list_for_each_entry(bank, &omap_gpio_list, node) {
1452
		if (!BANK_USED(bank) || !bank->loses_context)
1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465
			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) {
1466
		if (!BANK_USED(bank) || !bank->loses_context)
1467 1468 1469
			continue;

		pm_runtime_get_sync(bank->dev);
1470 1471
	}
}
1472
#endif
1473

1474
#if defined(CONFIG_PM)
1475 1476 1477 1478 1479
static void omap_gpio_init_context(struct gpio_bank *p)
{
	struct omap_gpio_reg_offs *regs = p->regs;
	void __iomem *base = p->base;

1480 1481 1482 1483 1484 1485 1486 1487 1488
	p->context.ctrl		= readl_relaxed(base + regs->ctrl);
	p->context.oe		= readl_relaxed(base + regs->direction);
	p->context.wake_en	= readl_relaxed(base + regs->wkup_en);
	p->context.leveldetect0	= readl_relaxed(base + regs->leveldetect0);
	p->context.leveldetect1	= readl_relaxed(base + regs->leveldetect1);
	p->context.risingdetect	= readl_relaxed(base + regs->risingdetect);
	p->context.fallingdetect = readl_relaxed(base + regs->fallingdetect);
	p->context.irqenable1	= readl_relaxed(base + regs->irqenable);
	p->context.irqenable2	= readl_relaxed(base + regs->irqenable2);
1489 1490

	if (regs->set_dataout && p->regs->clr_dataout)
1491
		p->context.dataout = readl_relaxed(base + regs->set_dataout);
1492
	else
1493
		p->context.dataout = readl_relaxed(base + regs->dataout);
1494 1495 1496 1497

	p->context_valid = true;
}

1498
static void omap_gpio_restore_context(struct gpio_bank *bank)
1499
{
1500
	writel_relaxed(bank->context.wake_en,
1501
				bank->base + bank->regs->wkup_en);
1502 1503
	writel_relaxed(bank->context.ctrl, bank->base + bank->regs->ctrl);
	writel_relaxed(bank->context.leveldetect0,
1504
				bank->base + bank->regs->leveldetect0);
1505
	writel_relaxed(bank->context.leveldetect1,
1506
				bank->base + bank->regs->leveldetect1);
1507
	writel_relaxed(bank->context.risingdetect,
1508
				bank->base + bank->regs->risingdetect);
1509
	writel_relaxed(bank->context.fallingdetect,
1510
				bank->base + bank->regs->fallingdetect);
1511
	if (bank->regs->set_dataout && bank->regs->clr_dataout)
1512
		writel_relaxed(bank->context.dataout,
1513 1514
				bank->base + bank->regs->set_dataout);
	else
1515
		writel_relaxed(bank->context.dataout,
1516
				bank->base + bank->regs->dataout);
1517
	writel_relaxed(bank->context.oe, bank->base + bank->regs->direction);
1518

1519
	if (bank->dbck_enable_mask) {
1520
		writel_relaxed(bank->context.debounce, bank->base +
1521
					bank->regs->debounce);
1522
		writel_relaxed(bank->context.debounce_en,
1523 1524
					bank->base + bank->regs->debounce_en);
	}
1525

1526
	writel_relaxed(bank->context.irqenable1,
1527
				bank->base + bank->regs->irqenable);
1528
	writel_relaxed(bank->context.irqenable2,
1529
				bank->base + bank->regs->irqenable2);
1530
}
1531
#endif /* CONFIG_PM */
1532
#else
1533 1534
#define omap_gpio_runtime_suspend NULL
#define omap_gpio_runtime_resume NULL
1535
static inline void omap_gpio_init_context(struct gpio_bank *p) {}
1536 1537
#endif

1538
static const struct dev_pm_ops gpio_pm_ops = {
1539 1540
	SET_RUNTIME_PM_OPS(omap_gpio_runtime_suspend, omap_gpio_runtime_resume,
									NULL)
1541 1542
};

1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589
#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,
};

1590
static const struct omap_gpio_platform_data omap2_pdata = {
1591 1592 1593 1594 1595
	.regs = &omap2_gpio_regs,
	.bank_width = 32,
	.dbck_flag = false,
};

1596
static const struct omap_gpio_platform_data omap3_pdata = {
1597 1598 1599 1600 1601
	.regs = &omap2_gpio_regs,
	.bank_width = 32,
	.dbck_flag = true,
};

1602
static const struct omap_gpio_platform_data omap4_pdata = {
1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625
	.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

1626 1627
static struct platform_driver omap_gpio_driver = {
	.probe		= omap_gpio_probe,
1628
	.remove		= omap_gpio_remove,
1629 1630
	.driver		= {
		.name	= "omap_gpio",
1631
		.pm	= &gpio_pm_ops,
1632
		.of_match_table = of_match_ptr(omap_gpio_match),
1633 1634 1635
	},
};

1636
/*
1637 1638 1639
 * gpio driver register needs to be done before
 * machine_init functions access gpio APIs.
 * Hence omap_gpio_drv_reg() is a postcore_initcall.
1640
 */
1641
static int __init omap_gpio_drv_reg(void)
1642
{
1643
	return platform_driver_register(&omap_gpio_driver);
1644
}
1645
postcore_initcall(omap_gpio_drv_reg);
1646 1647 1648 1649 1650 1651 1652 1653 1654 1655

static void __exit omap_gpio_exit(void)
{
	platform_driver_unregister(&omap_gpio_driver);
}
module_exit(omap_gpio_exit);

MODULE_DESCRIPTION("omap gpio driver");
MODULE_ALIAS("platform:gpio-omap");
MODULE_LICENSE("GPL v2");