| Tomasz Figa | 61dd726 | 2013-03-18 22:31:55 +0100 | [diff] [blame] | 1 | /* | 
 | 2 |  * S3C64xx specific support for pinctrl-samsung driver. | 
 | 3 |  * | 
 | 4 |  * Copyright (c) 2013 Tomasz Figa <tomasz.figa@gmail.com> | 
 | 5 |  * | 
 | 6 |  * Based on pinctrl-exynos.c, please see the file for original copyrights. | 
 | 7 |  * | 
 | 8 |  * This program is free software; you can redistribute it and/or modify | 
 | 9 |  * it under the terms of the GNU General Public License as published by | 
 | 10 |  * the Free Software Foundation; either version 2 of the License, or | 
 | 11 |  * (at your option) any later version. | 
 | 12 |  * | 
 | 13 |  * This file contains the Samsung S3C64xx specific information required by the | 
 | 14 |  * the Samsung pinctrl/gpiolib driver. It also includes the implementation of | 
 | 15 |  * external gpio and wakeup interrupt support. | 
 | 16 |  */ | 
 | 17 |  | 
 | 18 | #include <linux/module.h> | 
 | 19 | #include <linux/device.h> | 
 | 20 | #include <linux/interrupt.h> | 
 | 21 | #include <linux/irqdomain.h> | 
 | 22 | #include <linux/irq.h> | 
 | 23 | #include <linux/of_irq.h> | 
 | 24 | #include <linux/io.h> | 
| Tomasz Figa | a0d4262 | 2013-04-17 00:23:59 +0200 | [diff] [blame] | 25 | #include <linux/irqchip/chained_irq.h> | 
| Tomasz Figa | 61dd726 | 2013-03-18 22:31:55 +0100 | [diff] [blame] | 26 | #include <linux/slab.h> | 
 | 27 | #include <linux/err.h> | 
 | 28 |  | 
| Tomasz Figa | 61dd726 | 2013-03-18 22:31:55 +0100 | [diff] [blame] | 29 | #include "pinctrl-samsung.h" | 
 | 30 |  | 
 | 31 | #define NUM_EINT0		28 | 
 | 32 | #define NUM_EINT0_IRQ		4 | 
 | 33 | #define EINT_MAX_PER_REG	16 | 
 | 34 | #define EINT_MAX_PER_GROUP	16 | 
 | 35 |  | 
 | 36 | /* External GPIO and wakeup interrupt related definitions */ | 
 | 37 | #define SVC_GROUP_SHIFT		4 | 
 | 38 | #define SVC_GROUP_MASK		0xf | 
 | 39 | #define SVC_NUM_MASK		0xf | 
 | 40 | #define SVC_GROUP(x)		((x >> SVC_GROUP_SHIFT) & \ | 
 | 41 | 						SVC_GROUP_MASK) | 
 | 42 |  | 
 | 43 | #define EINT12CON_REG		0x200 | 
 | 44 | #define EINT12MASK_REG		0x240 | 
 | 45 | #define EINT12PEND_REG		0x260 | 
 | 46 |  | 
 | 47 | #define EINT_OFFS(i)		((i) % (2 * EINT_MAX_PER_GROUP)) | 
 | 48 | #define EINT_GROUP(i)		((i) / EINT_MAX_PER_GROUP) | 
 | 49 | #define EINT_REG(g)		(4 * ((g) / 2)) | 
 | 50 |  | 
 | 51 | #define EINTCON_REG(i)		(EINT12CON_REG + EINT_REG(EINT_GROUP(i))) | 
 | 52 | #define EINTMASK_REG(i)		(EINT12MASK_REG + EINT_REG(EINT_GROUP(i))) | 
 | 53 | #define EINTPEND_REG(i)		(EINT12PEND_REG + EINT_REG(EINT_GROUP(i))) | 
 | 54 |  | 
 | 55 | #define SERVICE_REG		0x284 | 
 | 56 | #define SERVICEPEND_REG		0x288 | 
 | 57 |  | 
 | 58 | #define EINT0CON0_REG		0x900 | 
 | 59 | #define EINT0MASK_REG		0x920 | 
 | 60 | #define EINT0PEND_REG		0x924 | 
 | 61 |  | 
 | 62 | /* S3C64xx specific external interrupt trigger types */ | 
 | 63 | #define EINT_LEVEL_LOW		0 | 
 | 64 | #define EINT_LEVEL_HIGH		1 | 
 | 65 | #define EINT_EDGE_FALLING	2 | 
 | 66 | #define EINT_EDGE_RISING	4 | 
 | 67 | #define EINT_EDGE_BOTH		6 | 
 | 68 | #define EINT_CON_MASK		0xF | 
 | 69 | #define EINT_CON_LEN		4 | 
 | 70 |  | 
 | 71 | static struct samsung_pin_bank_type bank_type_4bit_off = { | 
 | 72 | 	.fld_width = { 4, 1, 2, 0, 2, 2, }, | 
 | 73 | 	.reg_offset = { 0x00, 0x04, 0x08, 0, 0x0c, 0x10, }, | 
 | 74 | }; | 
 | 75 |  | 
 | 76 | static struct samsung_pin_bank_type bank_type_4bit_alive = { | 
 | 77 | 	.fld_width = { 4, 1, 2, }, | 
 | 78 | 	.reg_offset = { 0x00, 0x04, 0x08, }, | 
 | 79 | }; | 
 | 80 |  | 
 | 81 | static struct samsung_pin_bank_type bank_type_4bit2_off = { | 
 | 82 | 	.fld_width = { 4, 1, 2, 0, 2, 2, }, | 
 | 83 | 	.reg_offset = { 0x00, 0x08, 0x0c, 0, 0x10, 0x14, }, | 
 | 84 | }; | 
 | 85 |  | 
 | 86 | static struct samsung_pin_bank_type bank_type_4bit2_alive = { | 
 | 87 | 	.fld_width = { 4, 1, 2, }, | 
 | 88 | 	.reg_offset = { 0x00, 0x08, 0x0c, }, | 
 | 89 | }; | 
 | 90 |  | 
 | 91 | static struct samsung_pin_bank_type bank_type_2bit_off = { | 
 | 92 | 	.fld_width = { 2, 1, 2, 0, 2, 2, }, | 
 | 93 | 	.reg_offset = { 0x00, 0x04, 0x08, 0, 0x0c, 0x10, }, | 
 | 94 | }; | 
 | 95 |  | 
 | 96 | static struct samsung_pin_bank_type bank_type_2bit_alive = { | 
 | 97 | 	.fld_width = { 2, 1, 2, }, | 
 | 98 | 	.reg_offset = { 0x00, 0x04, 0x08, }, | 
 | 99 | }; | 
 | 100 |  | 
 | 101 | #define PIN_BANK_4BIT(pins, reg, id)			\ | 
 | 102 | 	{						\ | 
 | 103 | 		.type		= &bank_type_4bit_off,	\ | 
 | 104 | 		.pctl_offset	= reg,			\ | 
 | 105 | 		.nr_pins	= pins,			\ | 
 | 106 | 		.eint_type	= EINT_TYPE_NONE,	\ | 
 | 107 | 		.name		= id			\ | 
 | 108 | 	} | 
 | 109 |  | 
 | 110 | #define PIN_BANK_4BIT_EINTG(pins, reg, id, eoffs)	\ | 
 | 111 | 	{						\ | 
 | 112 | 		.type		= &bank_type_4bit_off,	\ | 
 | 113 | 		.pctl_offset	= reg,			\ | 
 | 114 | 		.nr_pins	= pins,			\ | 
 | 115 | 		.eint_type	= EINT_TYPE_GPIO,	\ | 
 | 116 | 		.eint_func	= 7,			\ | 
 | 117 | 		.eint_mask	= (1 << (pins)) - 1,	\ | 
 | 118 | 		.eint_offset	= eoffs,		\ | 
 | 119 | 		.name		= id			\ | 
 | 120 | 	} | 
 | 121 |  | 
 | 122 | #define PIN_BANK_4BIT_EINTW(pins, reg, id, eoffs, emask) \ | 
 | 123 | 	{						\ | 
 | 124 | 		.type		= &bank_type_4bit_alive,\ | 
 | 125 | 		.pctl_offset	= reg,			\ | 
 | 126 | 		.nr_pins	= pins,			\ | 
 | 127 | 		.eint_type	= EINT_TYPE_WKUP,	\ | 
 | 128 | 		.eint_func	= 3,			\ | 
 | 129 | 		.eint_mask	= emask,		\ | 
 | 130 | 		.eint_offset	= eoffs,		\ | 
 | 131 | 		.name		= id			\ | 
 | 132 | 	} | 
 | 133 |  | 
 | 134 | #define PIN_BANK_4BIT2_EINTG(pins, reg, id, eoffs)	\ | 
 | 135 | 	{						\ | 
 | 136 | 		.type		= &bank_type_4bit2_off,	\ | 
 | 137 | 		.pctl_offset	= reg,			\ | 
 | 138 | 		.nr_pins	= pins,			\ | 
 | 139 | 		.eint_type	= EINT_TYPE_GPIO,	\ | 
 | 140 | 		.eint_func	= 7,			\ | 
 | 141 | 		.eint_mask	= (1 << (pins)) - 1,	\ | 
 | 142 | 		.eint_offset	= eoffs,		\ | 
 | 143 | 		.name		= id			\ | 
 | 144 | 	} | 
 | 145 |  | 
 | 146 | #define PIN_BANK_4BIT2_EINTW(pins, reg, id, eoffs, emask) \ | 
 | 147 | 	{						\ | 
 | 148 | 		.type		= &bank_type_4bit2_alive,\ | 
 | 149 | 		.pctl_offset	= reg,			\ | 
 | 150 | 		.nr_pins	= pins,			\ | 
 | 151 | 		.eint_type	= EINT_TYPE_WKUP,	\ | 
 | 152 | 		.eint_func	= 3,			\ | 
 | 153 | 		.eint_mask	= emask,		\ | 
 | 154 | 		.eint_offset	= eoffs,		\ | 
 | 155 | 		.name		= id			\ | 
 | 156 | 	} | 
 | 157 |  | 
 | 158 | #define PIN_BANK_4BIT2_ALIVE(pins, reg, id)		\ | 
 | 159 | 	{						\ | 
 | 160 | 		.type		= &bank_type_4bit2_alive,\ | 
 | 161 | 		.pctl_offset	= reg,			\ | 
 | 162 | 		.nr_pins	= pins,			\ | 
 | 163 | 		.eint_type	= EINT_TYPE_NONE,	\ | 
 | 164 | 		.name		= id			\ | 
 | 165 | 	} | 
 | 166 |  | 
 | 167 | #define PIN_BANK_2BIT(pins, reg, id)			\ | 
 | 168 | 	{						\ | 
 | 169 | 		.type		= &bank_type_2bit_off,	\ | 
 | 170 | 		.pctl_offset	= reg,			\ | 
 | 171 | 		.nr_pins	= pins,			\ | 
 | 172 | 		.eint_type	= EINT_TYPE_NONE,	\ | 
 | 173 | 		.name		= id			\ | 
 | 174 | 	} | 
 | 175 |  | 
 | 176 | #define PIN_BANK_2BIT_EINTG(pins, reg, id, eoffs, emask) \ | 
 | 177 | 	{						\ | 
 | 178 | 		.type		= &bank_type_2bit_off,	\ | 
 | 179 | 		.pctl_offset	= reg,			\ | 
 | 180 | 		.nr_pins	= pins,			\ | 
 | 181 | 		.eint_type	= EINT_TYPE_GPIO,	\ | 
 | 182 | 		.eint_func	= 3,			\ | 
 | 183 | 		.eint_mask	= emask,		\ | 
 | 184 | 		.eint_offset	= eoffs,		\ | 
 | 185 | 		.name		= id			\ | 
 | 186 | 	} | 
 | 187 |  | 
 | 188 | #define PIN_BANK_2BIT_EINTW(pins, reg, id, eoffs)	\ | 
 | 189 | 	{						\ | 
 | 190 | 		.type		= &bank_type_2bit_alive,\ | 
 | 191 | 		.pctl_offset	= reg,			\ | 
 | 192 | 		.nr_pins	= pins,			\ | 
 | 193 | 		.eint_type	= EINT_TYPE_WKUP,	\ | 
 | 194 | 		.eint_func	= 2,			\ | 
 | 195 | 		.eint_mask	= (1 << (pins)) - 1,	\ | 
 | 196 | 		.eint_offset	= eoffs,		\ | 
 | 197 | 		.name		= id			\ | 
 | 198 | 	} | 
 | 199 |  | 
 | 200 | /** | 
 | 201 |  * struct s3c64xx_eint0_data: EINT0 common data | 
 | 202 |  * @drvdata: pin controller driver data | 
 | 203 |  * @domains: IRQ domains of particular EINT0 interrupts | 
 | 204 |  * @pins: pin offsets inside of banks of particular EINT0 interrupts | 
 | 205 |  */ | 
 | 206 | struct s3c64xx_eint0_data { | 
 | 207 | 	struct samsung_pinctrl_drv_data *drvdata; | 
 | 208 | 	struct irq_domain *domains[NUM_EINT0]; | 
 | 209 | 	u8 pins[NUM_EINT0]; | 
 | 210 | }; | 
 | 211 |  | 
 | 212 | /** | 
 | 213 |  * struct s3c64xx_eint0_domain_data: EINT0 per-domain data | 
 | 214 |  * @bank: pin bank related to the domain | 
 | 215 |  * @eints: EINT0 interrupts related to the domain | 
 | 216 |  */ | 
 | 217 | struct s3c64xx_eint0_domain_data { | 
 | 218 | 	struct samsung_pin_bank *bank; | 
 | 219 | 	u8 eints[]; | 
 | 220 | }; | 
 | 221 |  | 
 | 222 | /** | 
 | 223 |  * struct s3c64xx_eint_gpio_data: GPIO EINT data | 
 | 224 |  * @drvdata: pin controller driver data | 
 | 225 |  * @domains: array of domains related to EINT interrupt groups | 
 | 226 |  */ | 
 | 227 | struct s3c64xx_eint_gpio_data { | 
 | 228 | 	struct samsung_pinctrl_drv_data *drvdata; | 
 | 229 | 	struct irq_domain *domains[]; | 
 | 230 | }; | 
 | 231 |  | 
 | 232 | /* | 
 | 233 |  * Common functions for S3C64xx EINT configuration | 
 | 234 |  */ | 
 | 235 |  | 
 | 236 | static int s3c64xx_irq_get_trigger(unsigned int type) | 
 | 237 | { | 
 | 238 | 	int trigger; | 
 | 239 |  | 
 | 240 | 	switch (type) { | 
 | 241 | 	case IRQ_TYPE_EDGE_RISING: | 
 | 242 | 		trigger = EINT_EDGE_RISING; | 
 | 243 | 		break; | 
 | 244 | 	case IRQ_TYPE_EDGE_FALLING: | 
 | 245 | 		trigger = EINT_EDGE_FALLING; | 
 | 246 | 		break; | 
 | 247 | 	case IRQ_TYPE_EDGE_BOTH: | 
 | 248 | 		trigger = EINT_EDGE_BOTH; | 
 | 249 | 		break; | 
 | 250 | 	case IRQ_TYPE_LEVEL_HIGH: | 
 | 251 | 		trigger = EINT_LEVEL_HIGH; | 
 | 252 | 		break; | 
 | 253 | 	case IRQ_TYPE_LEVEL_LOW: | 
 | 254 | 		trigger = EINT_LEVEL_LOW; | 
 | 255 | 		break; | 
 | 256 | 	default: | 
 | 257 | 		return -EINVAL; | 
 | 258 | 	} | 
 | 259 |  | 
 | 260 | 	return trigger; | 
 | 261 | } | 
 | 262 |  | 
 | 263 | static void s3c64xx_irq_set_handler(unsigned int irq, unsigned int type) | 
 | 264 | { | 
 | 265 | 	/* Edge- and level-triggered interrupts need different handlers */ | 
 | 266 | 	if (type & IRQ_TYPE_EDGE_BOTH) | 
 | 267 | 		__irq_set_handler_locked(irq, handle_edge_irq); | 
 | 268 | 	else | 
 | 269 | 		__irq_set_handler_locked(irq, handle_level_irq); | 
 | 270 | } | 
 | 271 |  | 
 | 272 | static void s3c64xx_irq_set_function(struct samsung_pinctrl_drv_data *d, | 
 | 273 | 					struct samsung_pin_bank *bank, int pin) | 
 | 274 | { | 
 | 275 | 	struct samsung_pin_bank_type *bank_type = bank->type; | 
 | 276 | 	unsigned long flags; | 
 | 277 | 	void __iomem *reg; | 
 | 278 | 	u8 shift; | 
 | 279 | 	u32 mask; | 
 | 280 | 	u32 val; | 
 | 281 |  | 
 | 282 | 	/* Make sure that pin is configured as interrupt */ | 
 | 283 | 	reg = d->virt_base + bank->pctl_offset; | 
 | 284 | 	shift = pin; | 
 | 285 | 	if (bank_type->fld_width[PINCFG_TYPE_FUNC] * shift >= 32) { | 
 | 286 | 		/* 4-bit bank type with 2 con regs */ | 
 | 287 | 		reg += 4; | 
 | 288 | 		shift -= 8; | 
 | 289 | 	} | 
 | 290 |  | 
 | 291 | 	shift = shift * bank_type->fld_width[PINCFG_TYPE_FUNC]; | 
 | 292 | 	mask = (1 << bank_type->fld_width[PINCFG_TYPE_FUNC]) - 1; | 
 | 293 |  | 
 | 294 | 	spin_lock_irqsave(&bank->slock, flags); | 
 | 295 |  | 
 | 296 | 	val = readl(reg); | 
 | 297 | 	val &= ~(mask << shift); | 
 | 298 | 	val |= bank->eint_func << shift; | 
 | 299 | 	writel(val, reg); | 
 | 300 |  | 
 | 301 | 	spin_unlock_irqrestore(&bank->slock, flags); | 
 | 302 | } | 
 | 303 |  | 
 | 304 | /* | 
 | 305 |  * Functions for EINT GPIO configuration (EINT groups 1-9) | 
 | 306 |  */ | 
 | 307 |  | 
 | 308 | static inline void s3c64xx_gpio_irq_set_mask(struct irq_data *irqd, bool mask) | 
 | 309 | { | 
 | 310 | 	struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd); | 
 | 311 | 	struct samsung_pinctrl_drv_data *d = bank->drvdata; | 
 | 312 | 	unsigned char index = EINT_OFFS(bank->eint_offset) + irqd->hwirq; | 
 | 313 | 	void __iomem *reg = d->virt_base + EINTMASK_REG(bank->eint_offset); | 
 | 314 | 	u32 val; | 
 | 315 |  | 
 | 316 | 	val = readl(reg); | 
 | 317 | 	if (mask) | 
 | 318 | 		val |= 1 << index; | 
 | 319 | 	else | 
 | 320 | 		val &= ~(1 << index); | 
 | 321 | 	writel(val, reg); | 
 | 322 | } | 
 | 323 |  | 
 | 324 | static void s3c64xx_gpio_irq_unmask(struct irq_data *irqd) | 
 | 325 | { | 
 | 326 | 	s3c64xx_gpio_irq_set_mask(irqd, false); | 
 | 327 | } | 
 | 328 |  | 
 | 329 | static void s3c64xx_gpio_irq_mask(struct irq_data *irqd) | 
 | 330 | { | 
 | 331 | 	s3c64xx_gpio_irq_set_mask(irqd, true); | 
 | 332 | } | 
 | 333 |  | 
 | 334 | static void s3c64xx_gpio_irq_ack(struct irq_data *irqd) | 
 | 335 | { | 
 | 336 | 	struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd); | 
 | 337 | 	struct samsung_pinctrl_drv_data *d = bank->drvdata; | 
 | 338 | 	unsigned char index = EINT_OFFS(bank->eint_offset) + irqd->hwirq; | 
 | 339 | 	void __iomem *reg = d->virt_base + EINTPEND_REG(bank->eint_offset); | 
 | 340 |  | 
 | 341 | 	writel(1 << index, reg); | 
 | 342 | } | 
 | 343 |  | 
 | 344 | static int s3c64xx_gpio_irq_set_type(struct irq_data *irqd, unsigned int type) | 
 | 345 | { | 
 | 346 | 	struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd); | 
 | 347 | 	struct samsung_pinctrl_drv_data *d = bank->drvdata; | 
 | 348 | 	void __iomem *reg; | 
 | 349 | 	int trigger; | 
 | 350 | 	u8 shift; | 
 | 351 | 	u32 val; | 
 | 352 |  | 
 | 353 | 	trigger = s3c64xx_irq_get_trigger(type); | 
 | 354 | 	if (trigger < 0) { | 
 | 355 | 		pr_err("unsupported external interrupt type\n"); | 
 | 356 | 		return -EINVAL; | 
 | 357 | 	} | 
 | 358 |  | 
 | 359 | 	s3c64xx_irq_set_handler(irqd->irq, type); | 
 | 360 |  | 
 | 361 | 	/* Set up interrupt trigger */ | 
 | 362 | 	reg = d->virt_base + EINTCON_REG(bank->eint_offset); | 
 | 363 | 	shift = EINT_OFFS(bank->eint_offset) + irqd->hwirq; | 
 | 364 | 	shift = 4 * (shift / 4); /* 4 EINTs per trigger selector */ | 
 | 365 |  | 
 | 366 | 	val = readl(reg); | 
 | 367 | 	val &= ~(EINT_CON_MASK << shift); | 
 | 368 | 	val |= trigger << shift; | 
 | 369 | 	writel(val, reg); | 
 | 370 |  | 
 | 371 | 	s3c64xx_irq_set_function(d, bank, irqd->hwirq); | 
 | 372 |  | 
 | 373 | 	return 0; | 
 | 374 | } | 
 | 375 |  | 
 | 376 | /* | 
 | 377 |  * irq_chip for gpio interrupts. | 
 | 378 |  */ | 
 | 379 | static struct irq_chip s3c64xx_gpio_irq_chip = { | 
 | 380 | 	.name		= "GPIO", | 
 | 381 | 	.irq_unmask	= s3c64xx_gpio_irq_unmask, | 
 | 382 | 	.irq_mask	= s3c64xx_gpio_irq_mask, | 
 | 383 | 	.irq_ack	= s3c64xx_gpio_irq_ack, | 
 | 384 | 	.irq_set_type	= s3c64xx_gpio_irq_set_type, | 
 | 385 | }; | 
 | 386 |  | 
 | 387 | static int s3c64xx_gpio_irq_map(struct irq_domain *h, unsigned int virq, | 
 | 388 | 					irq_hw_number_t hw) | 
 | 389 | { | 
 | 390 | 	struct samsung_pin_bank *bank = h->host_data; | 
 | 391 |  | 
 | 392 | 	if (!(bank->eint_mask & (1 << hw))) | 
 | 393 | 		return -EINVAL; | 
 | 394 |  | 
 | 395 | 	irq_set_chip_and_handler(virq, | 
 | 396 | 				&s3c64xx_gpio_irq_chip, handle_level_irq); | 
 | 397 | 	irq_set_chip_data(virq, bank); | 
 | 398 | 	set_irq_flags(virq, IRQF_VALID); | 
 | 399 |  | 
 | 400 | 	return 0; | 
 | 401 | } | 
 | 402 |  | 
 | 403 | /* | 
 | 404 |  * irq domain callbacks for external gpio interrupt controller. | 
 | 405 |  */ | 
 | 406 | static const struct irq_domain_ops s3c64xx_gpio_irqd_ops = { | 
 | 407 | 	.map	= s3c64xx_gpio_irq_map, | 
 | 408 | 	.xlate	= irq_domain_xlate_twocell, | 
 | 409 | }; | 
 | 410 |  | 
 | 411 | static void s3c64xx_eint_gpio_irq(unsigned int irq, struct irq_desc *desc) | 
 | 412 | { | 
 | 413 | 	struct irq_chip *chip = irq_get_chip(irq); | 
 | 414 | 	struct s3c64xx_eint_gpio_data *data = irq_get_handler_data(irq); | 
 | 415 | 	struct samsung_pinctrl_drv_data *drvdata = data->drvdata; | 
 | 416 |  | 
 | 417 | 	chained_irq_enter(chip, desc); | 
 | 418 |  | 
 | 419 | 	do { | 
 | 420 | 		unsigned int svc; | 
 | 421 | 		unsigned int group; | 
 | 422 | 		unsigned int pin; | 
 | 423 | 		unsigned int virq; | 
 | 424 |  | 
 | 425 | 		svc = readl(drvdata->virt_base + SERVICE_REG); | 
 | 426 | 		group = SVC_GROUP(svc); | 
 | 427 | 		pin = svc & SVC_NUM_MASK; | 
 | 428 |  | 
 | 429 | 		if (!group) | 
 | 430 | 			break; | 
 | 431 |  | 
 | 432 | 		/* Group 1 is used for two pin banks */ | 
 | 433 | 		if (group == 1) { | 
 | 434 | 			if (pin < 8) | 
 | 435 | 				group = 0; | 
 | 436 | 			else | 
 | 437 | 				pin -= 8; | 
 | 438 | 		} | 
 | 439 |  | 
 | 440 | 		virq = irq_linear_revmap(data->domains[group], pin); | 
 | 441 | 		/* | 
 | 442 | 		 * Something must be really wrong if an unmapped EINT | 
 | 443 | 		 * was unmasked... | 
 | 444 | 		 */ | 
 | 445 | 		BUG_ON(!virq); | 
 | 446 |  | 
 | 447 | 		generic_handle_irq(virq); | 
 | 448 | 	} while (1); | 
 | 449 |  | 
 | 450 | 	chained_irq_exit(chip, desc); | 
 | 451 | } | 
 | 452 |  | 
 | 453 | /** | 
 | 454 |  * s3c64xx_eint_gpio_init() - setup handling of external gpio interrupts. | 
 | 455 |  * @d: driver data of samsung pinctrl driver. | 
 | 456 |  */ | 
 | 457 | static int s3c64xx_eint_gpio_init(struct samsung_pinctrl_drv_data *d) | 
 | 458 | { | 
 | 459 | 	struct s3c64xx_eint_gpio_data *data; | 
 | 460 | 	struct samsung_pin_bank *bank; | 
 | 461 | 	struct device *dev = d->dev; | 
 | 462 | 	unsigned int nr_domains; | 
 | 463 | 	unsigned int i; | 
 | 464 |  | 
 | 465 | 	if (!d->irq) { | 
 | 466 | 		dev_err(dev, "irq number not available\n"); | 
 | 467 | 		return -EINVAL; | 
 | 468 | 	} | 
 | 469 |  | 
 | 470 | 	nr_domains = 0; | 
 | 471 | 	bank = d->ctrl->pin_banks; | 
 | 472 | 	for (i = 0; i < d->ctrl->nr_banks; ++i, ++bank) { | 
 | 473 | 		unsigned int nr_eints; | 
 | 474 | 		unsigned int mask; | 
 | 475 |  | 
 | 476 | 		if (bank->eint_type != EINT_TYPE_GPIO) | 
 | 477 | 			continue; | 
 | 478 |  | 
 | 479 | 		mask = bank->eint_mask; | 
 | 480 | 		nr_eints = fls(mask); | 
 | 481 |  | 
 | 482 | 		bank->irq_domain = irq_domain_add_linear(bank->of_node, | 
 | 483 | 					nr_eints, &s3c64xx_gpio_irqd_ops, bank); | 
 | 484 | 		if (!bank->irq_domain) { | 
 | 485 | 			dev_err(dev, "gpio irq domain add failed\n"); | 
 | 486 | 			return -ENXIO; | 
 | 487 | 		} | 
 | 488 |  | 
 | 489 | 		++nr_domains; | 
 | 490 | 	} | 
 | 491 |  | 
 | 492 | 	data = devm_kzalloc(dev, sizeof(*data) | 
 | 493 | 			+ nr_domains * sizeof(*data->domains), GFP_KERNEL); | 
 | 494 | 	if (!data) { | 
 | 495 | 		dev_err(dev, "failed to allocate handler data\n"); | 
 | 496 | 		return -ENOMEM; | 
 | 497 | 	} | 
 | 498 | 	data->drvdata = d; | 
 | 499 |  | 
 | 500 | 	bank = d->ctrl->pin_banks; | 
 | 501 | 	nr_domains = 0; | 
 | 502 | 	for (i = 0; i < d->ctrl->nr_banks; ++i, ++bank) { | 
 | 503 | 		if (bank->eint_type != EINT_TYPE_GPIO) | 
 | 504 | 			continue; | 
 | 505 |  | 
 | 506 | 		data->domains[nr_domains++] = bank->irq_domain; | 
 | 507 | 	} | 
 | 508 |  | 
 | 509 | 	irq_set_chained_handler(d->irq, s3c64xx_eint_gpio_irq); | 
 | 510 | 	irq_set_handler_data(d->irq, data); | 
 | 511 |  | 
 | 512 | 	return 0; | 
 | 513 | } | 
 | 514 |  | 
 | 515 | /* | 
 | 516 |  * Functions for configuration of EINT0 wake-up interrupts | 
 | 517 |  */ | 
 | 518 |  | 
 | 519 | static inline void s3c64xx_eint0_irq_set_mask(struct irq_data *irqd, bool mask) | 
 | 520 | { | 
 | 521 | 	struct s3c64xx_eint0_domain_data *ddata = | 
 | 522 | 					irq_data_get_irq_chip_data(irqd); | 
 | 523 | 	struct samsung_pinctrl_drv_data *d = ddata->bank->drvdata; | 
 | 524 | 	u32 val; | 
 | 525 |  | 
 | 526 | 	val = readl(d->virt_base + EINT0MASK_REG); | 
 | 527 | 	if (mask) | 
 | 528 | 		val |= 1 << ddata->eints[irqd->hwirq]; | 
 | 529 | 	else | 
 | 530 | 		val &= ~(1 << ddata->eints[irqd->hwirq]); | 
 | 531 | 	writel(val, d->virt_base + EINT0MASK_REG); | 
 | 532 | } | 
 | 533 |  | 
 | 534 | static void s3c64xx_eint0_irq_unmask(struct irq_data *irqd) | 
 | 535 | { | 
 | 536 | 	s3c64xx_eint0_irq_set_mask(irqd, false); | 
 | 537 | } | 
 | 538 |  | 
 | 539 | static void s3c64xx_eint0_irq_mask(struct irq_data *irqd) | 
 | 540 | { | 
 | 541 | 	s3c64xx_eint0_irq_set_mask(irqd, true); | 
 | 542 | } | 
 | 543 |  | 
 | 544 | static void s3c64xx_eint0_irq_ack(struct irq_data *irqd) | 
 | 545 | { | 
 | 546 | 	struct s3c64xx_eint0_domain_data *ddata = | 
 | 547 | 					irq_data_get_irq_chip_data(irqd); | 
 | 548 | 	struct samsung_pinctrl_drv_data *d = ddata->bank->drvdata; | 
 | 549 |  | 
 | 550 | 	writel(1 << ddata->eints[irqd->hwirq], | 
 | 551 | 					d->virt_base + EINT0PEND_REG); | 
 | 552 | } | 
 | 553 |  | 
 | 554 | static int s3c64xx_eint0_irq_set_type(struct irq_data *irqd, unsigned int type) | 
 | 555 | { | 
 | 556 | 	struct s3c64xx_eint0_domain_data *ddata = | 
 | 557 | 					irq_data_get_irq_chip_data(irqd); | 
 | 558 | 	struct samsung_pin_bank *bank = ddata->bank; | 
 | 559 | 	struct samsung_pinctrl_drv_data *d = bank->drvdata; | 
 | 560 | 	void __iomem *reg; | 
 | 561 | 	int trigger; | 
 | 562 | 	u8 shift; | 
 | 563 | 	u32 val; | 
 | 564 |  | 
 | 565 | 	trigger = s3c64xx_irq_get_trigger(type); | 
 | 566 | 	if (trigger < 0) { | 
 | 567 | 		pr_err("unsupported external interrupt type\n"); | 
 | 568 | 		return -EINVAL; | 
 | 569 | 	} | 
 | 570 |  | 
 | 571 | 	s3c64xx_irq_set_handler(irqd->irq, type); | 
 | 572 |  | 
 | 573 | 	/* Set up interrupt trigger */ | 
 | 574 | 	reg = d->virt_base + EINT0CON0_REG; | 
 | 575 | 	shift = ddata->eints[irqd->hwirq]; | 
 | 576 | 	if (shift >= EINT_MAX_PER_REG) { | 
 | 577 | 		reg += 4; | 
 | 578 | 		shift -= EINT_MAX_PER_REG; | 
 | 579 | 	} | 
 | 580 | 	shift = EINT_CON_LEN * (shift / 2); | 
 | 581 |  | 
 | 582 | 	val = readl(reg); | 
 | 583 | 	val &= ~(EINT_CON_MASK << shift); | 
 | 584 | 	val |= trigger << shift; | 
 | 585 | 	writel(val, reg); | 
 | 586 |  | 
 | 587 | 	s3c64xx_irq_set_function(d, bank, irqd->hwirq); | 
 | 588 |  | 
 | 589 | 	return 0; | 
 | 590 | } | 
 | 591 |  | 
 | 592 | /* | 
 | 593 |  * irq_chip for wakeup interrupts | 
 | 594 |  */ | 
 | 595 | static struct irq_chip s3c64xx_eint0_irq_chip = { | 
 | 596 | 	.name		= "EINT0", | 
 | 597 | 	.irq_unmask	= s3c64xx_eint0_irq_unmask, | 
 | 598 | 	.irq_mask	= s3c64xx_eint0_irq_mask, | 
 | 599 | 	.irq_ack	= s3c64xx_eint0_irq_ack, | 
 | 600 | 	.irq_set_type	= s3c64xx_eint0_irq_set_type, | 
 | 601 | }; | 
 | 602 |  | 
 | 603 | static inline void s3c64xx_irq_demux_eint(unsigned int irq, | 
 | 604 | 					struct irq_desc *desc, u32 range) | 
 | 605 | { | 
 | 606 | 	struct irq_chip *chip = irq_get_chip(irq); | 
 | 607 | 	struct s3c64xx_eint0_data *data = irq_get_handler_data(irq); | 
 | 608 | 	struct samsung_pinctrl_drv_data *drvdata = data->drvdata; | 
 | 609 | 	unsigned int pend, mask; | 
 | 610 |  | 
 | 611 | 	chained_irq_enter(chip, desc); | 
 | 612 |  | 
 | 613 | 	pend = readl(drvdata->virt_base + EINT0PEND_REG); | 
 | 614 | 	mask = readl(drvdata->virt_base + EINT0MASK_REG); | 
 | 615 |  | 
 | 616 | 	pend = pend & range & ~mask; | 
 | 617 | 	pend &= range; | 
 | 618 |  | 
 | 619 | 	while (pend) { | 
 | 620 | 		unsigned int virq; | 
 | 621 |  | 
 | 622 | 		irq = fls(pend) - 1; | 
 | 623 | 		pend &= ~(1 << irq); | 
 | 624 |  | 
 | 625 | 		virq = irq_linear_revmap(data->domains[irq], data->pins[irq]); | 
 | 626 | 		/* | 
 | 627 | 		 * Something must be really wrong if an unmapped EINT | 
 | 628 | 		 * was unmasked... | 
 | 629 | 		 */ | 
 | 630 | 		BUG_ON(!virq); | 
 | 631 |  | 
 | 632 | 		generic_handle_irq(virq); | 
 | 633 | 	} | 
 | 634 |  | 
 | 635 | 	chained_irq_exit(chip, desc); | 
 | 636 | } | 
 | 637 |  | 
 | 638 | static void s3c64xx_demux_eint0_3(unsigned int irq, struct irq_desc *desc) | 
 | 639 | { | 
 | 640 | 	s3c64xx_irq_demux_eint(irq, desc, 0xf); | 
 | 641 | } | 
 | 642 |  | 
 | 643 | static void s3c64xx_demux_eint4_11(unsigned int irq, struct irq_desc *desc) | 
 | 644 | { | 
 | 645 | 	s3c64xx_irq_demux_eint(irq, desc, 0xff0); | 
 | 646 | } | 
 | 647 |  | 
 | 648 | static void s3c64xx_demux_eint12_19(unsigned int irq, struct irq_desc *desc) | 
 | 649 | { | 
 | 650 | 	s3c64xx_irq_demux_eint(irq, desc, 0xff000); | 
 | 651 | } | 
 | 652 |  | 
 | 653 | static void s3c64xx_demux_eint20_27(unsigned int irq, struct irq_desc *desc) | 
 | 654 | { | 
 | 655 | 	s3c64xx_irq_demux_eint(irq, desc, 0xff00000); | 
 | 656 | } | 
 | 657 |  | 
 | 658 | static irq_flow_handler_t s3c64xx_eint0_handlers[NUM_EINT0_IRQ] = { | 
 | 659 | 	s3c64xx_demux_eint0_3, | 
 | 660 | 	s3c64xx_demux_eint4_11, | 
 | 661 | 	s3c64xx_demux_eint12_19, | 
 | 662 | 	s3c64xx_demux_eint20_27, | 
 | 663 | }; | 
 | 664 |  | 
 | 665 | static int s3c64xx_eint0_irq_map(struct irq_domain *h, unsigned int virq, | 
 | 666 | 					irq_hw_number_t hw) | 
 | 667 | { | 
 | 668 | 	struct s3c64xx_eint0_domain_data *ddata = h->host_data; | 
 | 669 | 	struct samsung_pin_bank *bank = ddata->bank; | 
 | 670 |  | 
 | 671 | 	if (!(bank->eint_mask & (1 << hw))) | 
 | 672 | 		return -EINVAL; | 
 | 673 |  | 
 | 674 | 	irq_set_chip_and_handler(virq, | 
 | 675 | 				&s3c64xx_eint0_irq_chip, handle_level_irq); | 
 | 676 | 	irq_set_chip_data(virq, ddata); | 
 | 677 | 	set_irq_flags(virq, IRQF_VALID); | 
 | 678 |  | 
 | 679 | 	return 0; | 
 | 680 | } | 
 | 681 |  | 
 | 682 | /* | 
 | 683 |  * irq domain callbacks for external wakeup interrupt controller. | 
 | 684 |  */ | 
 | 685 | static const struct irq_domain_ops s3c64xx_eint0_irqd_ops = { | 
 | 686 | 	.map	= s3c64xx_eint0_irq_map, | 
 | 687 | 	.xlate	= irq_domain_xlate_twocell, | 
 | 688 | }; | 
 | 689 |  | 
 | 690 | /* list of external wakeup controllers supported */ | 
 | 691 | static const struct of_device_id s3c64xx_eint0_irq_ids[] = { | 
 | 692 | 	{ .compatible = "samsung,s3c64xx-wakeup-eint", }, | 
 | 693 | 	{ } | 
 | 694 | }; | 
 | 695 |  | 
 | 696 | /** | 
 | 697 |  * s3c64xx_eint_eint0_init() - setup handling of external wakeup interrupts. | 
 | 698 |  * @d: driver data of samsung pinctrl driver. | 
 | 699 |  */ | 
 | 700 | static int s3c64xx_eint_eint0_init(struct samsung_pinctrl_drv_data *d) | 
 | 701 | { | 
 | 702 | 	struct device *dev = d->dev; | 
 | 703 | 	struct device_node *eint0_np = NULL; | 
 | 704 | 	struct device_node *np; | 
 | 705 | 	struct samsung_pin_bank *bank; | 
 | 706 | 	struct s3c64xx_eint0_data *data; | 
 | 707 | 	unsigned int i; | 
 | 708 |  | 
 | 709 | 	for_each_child_of_node(dev->of_node, np) { | 
 | 710 | 		if (of_match_node(s3c64xx_eint0_irq_ids, np)) { | 
 | 711 | 			eint0_np = np; | 
 | 712 | 			break; | 
 | 713 | 		} | 
 | 714 | 	} | 
 | 715 | 	if (!eint0_np) | 
 | 716 | 		return -ENODEV; | 
 | 717 |  | 
 | 718 | 	data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); | 
 | 719 | 	if (!data) { | 
 | 720 | 		dev_err(dev, "could not allocate memory for wkup eint data\n"); | 
 | 721 | 		return -ENOMEM; | 
 | 722 | 	} | 
 | 723 | 	data->drvdata = d; | 
 | 724 |  | 
 | 725 | 	for (i = 0; i < NUM_EINT0_IRQ; ++i) { | 
 | 726 | 		unsigned int irq; | 
 | 727 |  | 
 | 728 | 		irq = irq_of_parse_and_map(eint0_np, i); | 
 | 729 | 		if (!irq) { | 
 | 730 | 			dev_err(dev, "failed to get wakeup EINT IRQ %d\n", i); | 
 | 731 | 			return -ENXIO; | 
 | 732 | 		} | 
 | 733 |  | 
 | 734 | 		irq_set_chained_handler(irq, s3c64xx_eint0_handlers[i]); | 
 | 735 | 		irq_set_handler_data(irq, data); | 
 | 736 | 	} | 
 | 737 |  | 
 | 738 | 	bank = d->ctrl->pin_banks; | 
 | 739 | 	for (i = 0; i < d->ctrl->nr_banks; ++i, ++bank) { | 
 | 740 | 		struct s3c64xx_eint0_domain_data *ddata; | 
 | 741 | 		unsigned int nr_eints; | 
 | 742 | 		unsigned int mask; | 
 | 743 | 		unsigned int irq; | 
 | 744 | 		unsigned int pin; | 
 | 745 |  | 
 | 746 | 		if (bank->eint_type != EINT_TYPE_WKUP) | 
 | 747 | 			continue; | 
 | 748 |  | 
 | 749 | 		mask = bank->eint_mask; | 
 | 750 | 		nr_eints = fls(mask); | 
 | 751 |  | 
 | 752 | 		ddata = devm_kzalloc(dev, | 
 | 753 | 				sizeof(*ddata) + nr_eints, GFP_KERNEL); | 
 | 754 | 		if (!ddata) { | 
 | 755 | 			dev_err(dev, "failed to allocate domain data\n"); | 
 | 756 | 			return -ENOMEM; | 
 | 757 | 		} | 
 | 758 | 		ddata->bank = bank; | 
 | 759 |  | 
 | 760 | 		bank->irq_domain = irq_domain_add_linear(bank->of_node, | 
 | 761 | 				nr_eints, &s3c64xx_eint0_irqd_ops, ddata); | 
 | 762 | 		if (!bank->irq_domain) { | 
 | 763 | 			dev_err(dev, "wkup irq domain add failed\n"); | 
 | 764 | 			return -ENXIO; | 
 | 765 | 		} | 
 | 766 |  | 
 | 767 | 		irq = bank->eint_offset; | 
 | 768 | 		mask = bank->eint_mask; | 
 | 769 | 		for (pin = 0; mask; ++pin, mask >>= 1) { | 
 | 770 | 			if (!(mask & 1)) | 
 | 771 | 				continue; | 
 | 772 | 			data->domains[irq] = bank->irq_domain; | 
 | 773 | 			data->pins[irq] = pin; | 
 | 774 | 			ddata->eints[pin] = irq; | 
 | 775 | 			++irq; | 
 | 776 | 		} | 
 | 777 | 	} | 
 | 778 |  | 
 | 779 | 	return 0; | 
 | 780 | } | 
 | 781 |  | 
 | 782 | /* pin banks of s3c64xx pin-controller 0 */ | 
 | 783 | static struct samsung_pin_bank s3c64xx_pin_banks0[] = { | 
 | 784 | 	PIN_BANK_4BIT_EINTG(8, 0x000, "gpa", 0), | 
 | 785 | 	PIN_BANK_4BIT_EINTG(7, 0x020, "gpb", 8), | 
 | 786 | 	PIN_BANK_4BIT_EINTG(8, 0x040, "gpc", 16), | 
 | 787 | 	PIN_BANK_4BIT_EINTG(5, 0x060, "gpd", 32), | 
 | 788 | 	PIN_BANK_4BIT(5, 0x080, "gpe"), | 
 | 789 | 	PIN_BANK_2BIT_EINTG(16, 0x0a0, "gpf", 48, 0x3fff), | 
 | 790 | 	PIN_BANK_4BIT_EINTG(7, 0x0c0, "gpg", 64), | 
 | 791 | 	PIN_BANK_4BIT2_EINTG(10, 0x0e0, "gph", 80), | 
 | 792 | 	PIN_BANK_2BIT(16, 0x100, "gpi"), | 
 | 793 | 	PIN_BANK_2BIT(12, 0x120, "gpj"), | 
 | 794 | 	PIN_BANK_4BIT2_ALIVE(16, 0x800, "gpk"), | 
 | 795 | 	PIN_BANK_4BIT2_EINTW(15, 0x810, "gpl", 16, 0x7f00), | 
 | 796 | 	PIN_BANK_4BIT_EINTW(6, 0x820, "gpm", 23, 0x1f), | 
 | 797 | 	PIN_BANK_2BIT_EINTW(16, 0x830, "gpn", 0), | 
 | 798 | 	PIN_BANK_2BIT_EINTG(16, 0x140, "gpo", 96, 0xffff), | 
 | 799 | 	PIN_BANK_2BIT_EINTG(15, 0x160, "gpp", 112, 0x7fff), | 
 | 800 | 	PIN_BANK_2BIT_EINTG(9, 0x180, "gpq", 128, 0x1ff), | 
 | 801 | }; | 
 | 802 |  | 
 | 803 | /* | 
 | 804 |  * Samsung pinctrl driver data for S3C64xx SoC. S3C64xx SoC includes | 
 | 805 |  * one gpio/pin-mux/pinconfig controller. | 
 | 806 |  */ | 
 | 807 | struct samsung_pin_ctrl s3c64xx_pin_ctrl[] = { | 
 | 808 | 	{ | 
 | 809 | 		/* pin-controller instance 1 data */ | 
 | 810 | 		.pin_banks	= s3c64xx_pin_banks0, | 
 | 811 | 		.nr_banks	= ARRAY_SIZE(s3c64xx_pin_banks0), | 
 | 812 | 		.eint_gpio_init = s3c64xx_eint_gpio_init, | 
 | 813 | 		.eint_wkup_init = s3c64xx_eint_eint0_init, | 
 | 814 | 		.label		= "S3C64xx-GPIO", | 
 | 815 | 	}, | 
 | 816 | }; |