blob: 4c632812ccff2dbd8086b0640f58774edf23e0fb [file] [log] [blame]
Tomasz Figa61dd7262013-03-18 22:31:55 +01001/*
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 Figaa0d42622013-04-17 00:23:59 +020025#include <linux/irqchip/chained_irq.h>
Tomasz Figa61dd7262013-03-18 22:31:55 +010026#include <linux/slab.h>
27#include <linux/err.h>
28
Tomasz Figa61dd7262013-03-18 22:31:55 +010029#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
Tomasz Figa94ce9442014-09-23 21:05:39 +020071static const struct samsung_pin_bank_type bank_type_4bit_off = {
Tomasz Figa61dd7262013-03-18 22:31:55 +010072 .fld_width = { 4, 1, 2, 0, 2, 2, },
73 .reg_offset = { 0x00, 0x04, 0x08, 0, 0x0c, 0x10, },
74};
75
Tomasz Figa94ce9442014-09-23 21:05:39 +020076static const struct samsung_pin_bank_type bank_type_4bit_alive = {
Tomasz Figa61dd7262013-03-18 22:31:55 +010077 .fld_width = { 4, 1, 2, },
78 .reg_offset = { 0x00, 0x04, 0x08, },
79};
80
Tomasz Figa94ce9442014-09-23 21:05:39 +020081static const struct samsung_pin_bank_type bank_type_4bit2_off = {
Tomasz Figa61dd7262013-03-18 22:31:55 +010082 .fld_width = { 4, 1, 2, 0, 2, 2, },
83 .reg_offset = { 0x00, 0x08, 0x0c, 0, 0x10, 0x14, },
84};
85
Tomasz Figa94ce9442014-09-23 21:05:39 +020086static const struct samsung_pin_bank_type bank_type_4bit2_alive = {
Tomasz Figa61dd7262013-03-18 22:31:55 +010087 .fld_width = { 4, 1, 2, },
88 .reg_offset = { 0x00, 0x08, 0x0c, },
89};
90
Tomasz Figa94ce9442014-09-23 21:05:39 +020091static const struct samsung_pin_bank_type bank_type_2bit_off = {
Tomasz Figa61dd7262013-03-18 22:31:55 +010092 .fld_width = { 2, 1, 2, 0, 2, 2, },
93 .reg_offset = { 0x00, 0x04, 0x08, 0, 0x0c, 0x10, },
94};
95
Tomasz Figa94ce9442014-09-23 21:05:39 +020096static const struct samsung_pin_bank_type bank_type_2bit_alive = {
Tomasz Figa61dd7262013-03-18 22:31:55 +010097 .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 */
206struct 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 */
217struct 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 */
227struct 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
236static 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
Thomas Gleixnerf66eb492015-06-23 15:52:57 +0200263static void s3c64xx_irq_set_handler(struct irq_data *d, unsigned int type)
Tomasz Figa61dd7262013-03-18 22:31:55 +0100264{
265 /* Edge- and level-triggered interrupts need different handlers */
266 if (type & IRQ_TYPE_EDGE_BOTH)
Thomas Gleixnerf66eb492015-06-23 15:52:57 +0200267 irq_set_handler_locked(d, handle_edge_irq);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100268 else
Thomas Gleixnerf66eb492015-06-23 15:52:57 +0200269 irq_set_handler_locked(d, handle_level_irq);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100270}
271
272static void s3c64xx_irq_set_function(struct samsung_pinctrl_drv_data *d,
273 struct samsung_pin_bank *bank, int pin)
274{
Tomasz Figa94ce9442014-09-23 21:05:39 +0200275 const struct samsung_pin_bank_type *bank_type = bank->type;
Tomasz Figa61dd7262013-03-18 22:31:55 +0100276 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 */
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900283 reg = bank->pctl_base + bank->pctl_offset;
Tomasz Figa61dd7262013-03-18 22:31:55 +0100284 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
308static 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);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100311 unsigned char index = EINT_OFFS(bank->eint_offset) + irqd->hwirq;
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900312 void __iomem *reg = bank->eint_base + EINTMASK_REG(bank->eint_offset);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100313 u32 val;
314
315 val = readl(reg);
316 if (mask)
317 val |= 1 << index;
318 else
319 val &= ~(1 << index);
320 writel(val, reg);
321}
322
323static void s3c64xx_gpio_irq_unmask(struct irq_data *irqd)
324{
325 s3c64xx_gpio_irq_set_mask(irqd, false);
326}
327
328static void s3c64xx_gpio_irq_mask(struct irq_data *irqd)
329{
330 s3c64xx_gpio_irq_set_mask(irqd, true);
331}
332
333static void s3c64xx_gpio_irq_ack(struct irq_data *irqd)
334{
335 struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100336 unsigned char index = EINT_OFFS(bank->eint_offset) + irqd->hwirq;
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900337 void __iomem *reg = bank->eint_base + EINTPEND_REG(bank->eint_offset);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100338
339 writel(1 << index, reg);
340}
341
342static int s3c64xx_gpio_irq_set_type(struct irq_data *irqd, unsigned int type)
343{
344 struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd);
345 struct samsung_pinctrl_drv_data *d = bank->drvdata;
346 void __iomem *reg;
347 int trigger;
348 u8 shift;
349 u32 val;
350
351 trigger = s3c64xx_irq_get_trigger(type);
352 if (trigger < 0) {
353 pr_err("unsupported external interrupt type\n");
354 return -EINVAL;
355 }
356
Thomas Gleixnerf66eb492015-06-23 15:52:57 +0200357 s3c64xx_irq_set_handler(irqd, type);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100358
359 /* Set up interrupt trigger */
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900360 reg = bank->eint_base + EINTCON_REG(bank->eint_offset);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100361 shift = EINT_OFFS(bank->eint_offset) + irqd->hwirq;
362 shift = 4 * (shift / 4); /* 4 EINTs per trigger selector */
363
364 val = readl(reg);
365 val &= ~(EINT_CON_MASK << shift);
366 val |= trigger << shift;
367 writel(val, reg);
368
369 s3c64xx_irq_set_function(d, bank, irqd->hwirq);
370
371 return 0;
372}
373
374/*
375 * irq_chip for gpio interrupts.
376 */
377static struct irq_chip s3c64xx_gpio_irq_chip = {
378 .name = "GPIO",
379 .irq_unmask = s3c64xx_gpio_irq_unmask,
380 .irq_mask = s3c64xx_gpio_irq_mask,
381 .irq_ack = s3c64xx_gpio_irq_ack,
382 .irq_set_type = s3c64xx_gpio_irq_set_type,
383};
384
385static int s3c64xx_gpio_irq_map(struct irq_domain *h, unsigned int virq,
386 irq_hw_number_t hw)
387{
388 struct samsung_pin_bank *bank = h->host_data;
389
390 if (!(bank->eint_mask & (1 << hw)))
391 return -EINVAL;
392
393 irq_set_chip_and_handler(virq,
394 &s3c64xx_gpio_irq_chip, handle_level_irq);
395 irq_set_chip_data(virq, bank);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100396
397 return 0;
398}
399
400/*
401 * irq domain callbacks for external gpio interrupt controller.
402 */
403static const struct irq_domain_ops s3c64xx_gpio_irqd_ops = {
404 .map = s3c64xx_gpio_irq_map,
405 .xlate = irq_domain_xlate_twocell,
406};
407
Thomas Gleixnerbd0b9ac2015-09-14 10:42:37 +0200408static void s3c64xx_eint_gpio_irq(struct irq_desc *desc)
Tomasz Figa61dd7262013-03-18 22:31:55 +0100409{
Jiang Liu5663bb22015-06-04 12:13:16 +0800410 struct irq_chip *chip = irq_desc_get_chip(desc);
411 struct s3c64xx_eint_gpio_data *data = irq_desc_get_handler_data(desc);
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900412 struct irq_data *irqd = irq_desc_get_irq_data(desc);
413 struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100414
415 chained_irq_enter(chip, desc);
416
417 do {
418 unsigned int svc;
419 unsigned int group;
420 unsigned int pin;
421 unsigned int virq;
422
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900423 svc = readl(bank->eint_base + SERVICE_REG);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100424 group = SVC_GROUP(svc);
425 pin = svc & SVC_NUM_MASK;
426
427 if (!group)
428 break;
429
430 /* Group 1 is used for two pin banks */
431 if (group == 1) {
432 if (pin < 8)
433 group = 0;
434 else
435 pin -= 8;
436 }
437
438 virq = irq_linear_revmap(data->domains[group], pin);
439 /*
440 * Something must be really wrong if an unmapped EINT
441 * was unmasked...
442 */
443 BUG_ON(!virq);
444
445 generic_handle_irq(virq);
446 } while (1);
447
448 chained_irq_exit(chip, desc);
449}
450
451/**
452 * s3c64xx_eint_gpio_init() - setup handling of external gpio interrupts.
453 * @d: driver data of samsung pinctrl driver.
454 */
455static int s3c64xx_eint_gpio_init(struct samsung_pinctrl_drv_data *d)
456{
457 struct s3c64xx_eint_gpio_data *data;
458 struct samsung_pin_bank *bank;
459 struct device *dev = d->dev;
460 unsigned int nr_domains;
461 unsigned int i;
462
463 if (!d->irq) {
464 dev_err(dev, "irq number not available\n");
465 return -EINVAL;
466 }
467
468 nr_domains = 0;
Tomasz Figa1bf00d72014-09-23 21:05:40 +0200469 bank = d->pin_banks;
470 for (i = 0; i < d->nr_banks; ++i, ++bank) {
Tomasz Figa61dd7262013-03-18 22:31:55 +0100471 unsigned int nr_eints;
472 unsigned int mask;
473
474 if (bank->eint_type != EINT_TYPE_GPIO)
475 continue;
476
477 mask = bank->eint_mask;
478 nr_eints = fls(mask);
479
480 bank->irq_domain = irq_domain_add_linear(bank->of_node,
481 nr_eints, &s3c64xx_gpio_irqd_ops, bank);
482 if (!bank->irq_domain) {
483 dev_err(dev, "gpio irq domain add failed\n");
484 return -ENXIO;
485 }
486
487 ++nr_domains;
488 }
489
490 data = devm_kzalloc(dev, sizeof(*data)
491 + nr_domains * sizeof(*data->domains), GFP_KERNEL);
492 if (!data) {
493 dev_err(dev, "failed to allocate handler data\n");
494 return -ENOMEM;
495 }
496 data->drvdata = d;
497
Tomasz Figa1bf00d72014-09-23 21:05:40 +0200498 bank = d->pin_banks;
Tomasz Figa61dd7262013-03-18 22:31:55 +0100499 nr_domains = 0;
Tomasz Figa1bf00d72014-09-23 21:05:40 +0200500 for (i = 0; i < d->nr_banks; ++i, ++bank) {
Tomasz Figa61dd7262013-03-18 22:31:55 +0100501 if (bank->eint_type != EINT_TYPE_GPIO)
502 continue;
503
504 data->domains[nr_domains++] = bank->irq_domain;
505 }
506
Thomas Gleixner623a6502015-06-21 20:16:18 +0200507 irq_set_chained_handler_and_data(d->irq, s3c64xx_eint_gpio_irq, data);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100508
509 return 0;
510}
511
512/*
513 * Functions for configuration of EINT0 wake-up interrupts
514 */
515
516static inline void s3c64xx_eint0_irq_set_mask(struct irq_data *irqd, bool mask)
517{
518 struct s3c64xx_eint0_domain_data *ddata =
519 irq_data_get_irq_chip_data(irqd);
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900520 struct samsung_pin_bank *bank = ddata->bank;
Tomasz Figa61dd7262013-03-18 22:31:55 +0100521 u32 val;
522
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900523 val = readl(bank->eint_base + EINT0MASK_REG);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100524 if (mask)
525 val |= 1 << ddata->eints[irqd->hwirq];
526 else
527 val &= ~(1 << ddata->eints[irqd->hwirq]);
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900528 writel(val, bank->eint_base + EINT0MASK_REG);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100529}
530
531static void s3c64xx_eint0_irq_unmask(struct irq_data *irqd)
532{
533 s3c64xx_eint0_irq_set_mask(irqd, false);
534}
535
536static void s3c64xx_eint0_irq_mask(struct irq_data *irqd)
537{
538 s3c64xx_eint0_irq_set_mask(irqd, true);
539}
540
541static void s3c64xx_eint0_irq_ack(struct irq_data *irqd)
542{
543 struct s3c64xx_eint0_domain_data *ddata =
544 irq_data_get_irq_chip_data(irqd);
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900545 struct samsung_pin_bank *bank = ddata->bank;
Tomasz Figa61dd7262013-03-18 22:31:55 +0100546
547 writel(1 << ddata->eints[irqd->hwirq],
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900548 bank->eint_base + EINT0PEND_REG);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100549}
550
551static int s3c64xx_eint0_irq_set_type(struct irq_data *irqd, unsigned int type)
552{
553 struct s3c64xx_eint0_domain_data *ddata =
554 irq_data_get_irq_chip_data(irqd);
555 struct samsung_pin_bank *bank = ddata->bank;
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900556 struct samsung_pinctrl_drv_data *d = ddata->bank->drvdata;
Tomasz Figa61dd7262013-03-18 22:31:55 +0100557 void __iomem *reg;
558 int trigger;
559 u8 shift;
560 u32 val;
561
562 trigger = s3c64xx_irq_get_trigger(type);
563 if (trigger < 0) {
564 pr_err("unsupported external interrupt type\n");
565 return -EINVAL;
566 }
567
Thomas Gleixnerf66eb492015-06-23 15:52:57 +0200568 s3c64xx_irq_set_handler(irqd, type);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100569
570 /* Set up interrupt trigger */
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900571 reg = bank->eint_base + EINT0CON0_REG;
Tomasz Figa61dd7262013-03-18 22:31:55 +0100572 shift = ddata->eints[irqd->hwirq];
573 if (shift >= EINT_MAX_PER_REG) {
574 reg += 4;
575 shift -= EINT_MAX_PER_REG;
576 }
577 shift = EINT_CON_LEN * (shift / 2);
578
579 val = readl(reg);
580 val &= ~(EINT_CON_MASK << shift);
581 val |= trigger << shift;
582 writel(val, reg);
583
584 s3c64xx_irq_set_function(d, bank, irqd->hwirq);
585
586 return 0;
587}
588
589/*
590 * irq_chip for wakeup interrupts
591 */
592static struct irq_chip s3c64xx_eint0_irq_chip = {
593 .name = "EINT0",
594 .irq_unmask = s3c64xx_eint0_irq_unmask,
595 .irq_mask = s3c64xx_eint0_irq_mask,
596 .irq_ack = s3c64xx_eint0_irq_ack,
597 .irq_set_type = s3c64xx_eint0_irq_set_type,
598};
599
Jiang Liu5663bb22015-06-04 12:13:16 +0800600static inline void s3c64xx_irq_demux_eint(struct irq_desc *desc, u32 range)
Tomasz Figa61dd7262013-03-18 22:31:55 +0100601{
Jiang Liu5663bb22015-06-04 12:13:16 +0800602 struct irq_chip *chip = irq_desc_get_chip(desc);
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900603 struct irq_data *irqd = irq_desc_get_irq_data(desc);
604 struct s3c64xx_eint0_domain_data *ddata =
605 irq_data_get_irq_chip_data(irqd);
606 struct samsung_pin_bank *bank = ddata->bank;
607
Jiang Liu5663bb22015-06-04 12:13:16 +0800608 struct s3c64xx_eint0_data *data = irq_desc_get_handler_data(desc);
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900609
Tomasz Figa61dd7262013-03-18 22:31:55 +0100610 unsigned int pend, mask;
611
612 chained_irq_enter(chip, desc);
613
Chanwoo Choi8b1bd112016-11-09 17:40:10 +0900614 pend = readl(bank->eint_base + EINT0PEND_REG);
615 mask = readl(bank->eint_base + EINT0MASK_REG);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100616
617 pend = pend & range & ~mask;
618 pend &= range;
619
620 while (pend) {
Jiang Liu5663bb22015-06-04 12:13:16 +0800621 unsigned int virq, irq;
Tomasz Figa61dd7262013-03-18 22:31:55 +0100622
623 irq = fls(pend) - 1;
624 pend &= ~(1 << irq);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100625 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
Thomas Gleixnerbd0b9ac2015-09-14 10:42:37 +0200638static void s3c64xx_demux_eint0_3(struct irq_desc *desc)
Tomasz Figa61dd7262013-03-18 22:31:55 +0100639{
Jiang Liu5663bb22015-06-04 12:13:16 +0800640 s3c64xx_irq_demux_eint(desc, 0xf);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100641}
642
Thomas Gleixnerbd0b9ac2015-09-14 10:42:37 +0200643static void s3c64xx_demux_eint4_11(struct irq_desc *desc)
Tomasz Figa61dd7262013-03-18 22:31:55 +0100644{
Jiang Liu5663bb22015-06-04 12:13:16 +0800645 s3c64xx_irq_demux_eint(desc, 0xff0);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100646}
647
Thomas Gleixnerbd0b9ac2015-09-14 10:42:37 +0200648static void s3c64xx_demux_eint12_19(struct irq_desc *desc)
Tomasz Figa61dd7262013-03-18 22:31:55 +0100649{
Jiang Liu5663bb22015-06-04 12:13:16 +0800650 s3c64xx_irq_demux_eint(desc, 0xff000);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100651}
652
Thomas Gleixnerbd0b9ac2015-09-14 10:42:37 +0200653static void s3c64xx_demux_eint20_27(struct irq_desc *desc)
Tomasz Figa61dd7262013-03-18 22:31:55 +0100654{
Jiang Liu5663bb22015-06-04 12:13:16 +0800655 s3c64xx_irq_demux_eint(desc, 0xff00000);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100656}
657
658static 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
665static 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);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100677
678 return 0;
679}
680
681/*
682 * irq domain callbacks for external wakeup interrupt controller.
683 */
684static const struct irq_domain_ops s3c64xx_eint0_irqd_ops = {
685 .map = s3c64xx_eint0_irq_map,
686 .xlate = irq_domain_xlate_twocell,
687};
688
689/* list of external wakeup controllers supported */
690static const struct of_device_id s3c64xx_eint0_irq_ids[] = {
691 { .compatible = "samsung,s3c64xx-wakeup-eint", },
692 { }
693};
694
695/**
696 * s3c64xx_eint_eint0_init() - setup handling of external wakeup interrupts.
697 * @d: driver data of samsung pinctrl driver.
698 */
699static int s3c64xx_eint_eint0_init(struct samsung_pinctrl_drv_data *d)
700{
701 struct device *dev = d->dev;
702 struct device_node *eint0_np = NULL;
703 struct device_node *np;
704 struct samsung_pin_bank *bank;
705 struct s3c64xx_eint0_data *data;
706 unsigned int i;
707
708 for_each_child_of_node(dev->of_node, np) {
709 if (of_match_node(s3c64xx_eint0_irq_ids, np)) {
710 eint0_np = np;
711 break;
712 }
713 }
714 if (!eint0_np)
715 return -ENODEV;
716
717 data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);
718 if (!data) {
719 dev_err(dev, "could not allocate memory for wkup eint data\n");
720 return -ENOMEM;
721 }
722 data->drvdata = d;
723
724 for (i = 0; i < NUM_EINT0_IRQ; ++i) {
725 unsigned int irq;
726
727 irq = irq_of_parse_and_map(eint0_np, i);
728 if (!irq) {
729 dev_err(dev, "failed to get wakeup EINT IRQ %d\n", i);
730 return -ENXIO;
731 }
732
Thomas Gleixner623a6502015-06-21 20:16:18 +0200733 irq_set_chained_handler_and_data(irq,
734 s3c64xx_eint0_handlers[i],
735 data);
Tomasz Figa61dd7262013-03-18 22:31:55 +0100736 }
737
Tomasz Figa1bf00d72014-09-23 21:05:40 +0200738 bank = d->pin_banks;
739 for (i = 0; i < d->nr_banks; ++i, ++bank) {
Tomasz Figa61dd7262013-03-18 22:31:55 +0100740 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 */
Tomasz Figa8100cf42014-09-23 21:05:41 +0200783static const struct samsung_pin_bank_data s3c64xx_pin_banks0[] __initconst = {
Tomasz Figa61dd7262013-03-18 22:31:55 +0100784 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 */
Tomasz Figa1bf00d72014-09-23 21:05:40 +0200807const struct samsung_pin_ctrl s3c64xx_pin_ctrl[] __initconst = {
Tomasz Figa61dd7262013-03-18 22:31:55 +0100808 {
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,
Tomasz Figa61dd7262013-03-18 22:31:55 +0100814 },
815};