Linux Audio

Check our new training course

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