| /* |
| * S3C64xx specific support for pinctrl-samsung driver. |
| * |
| * Copyright (c) 2013 Tomasz Figa <tomasz.figa@gmail.com> |
| * |
| * Based on pinctrl-exynos.c, please see the file for original copyrights. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This file contains the Samsung S3C64xx specific information required by the |
| * the Samsung pinctrl/gpiolib driver. It also includes the implementation of |
| * external gpio and wakeup interrupt support. |
| */ |
| |
| #include <linux/module.h> |
| #include <linux/device.h> |
| #include <linux/interrupt.h> |
| #include <linux/irqdomain.h> |
| #include <linux/irq.h> |
| #include <linux/of_irq.h> |
| #include <linux/io.h> |
| #include <linux/irqchip/chained_irq.h> |
| #include <linux/slab.h> |
| #include <linux/err.h> |
| |
| #include "pinctrl-samsung.h" |
| |
| #define NUM_EINT0 28 |
| #define NUM_EINT0_IRQ 4 |
| #define EINT_MAX_PER_REG 16 |
| #define EINT_MAX_PER_GROUP 16 |
| |
| /* External GPIO and wakeup interrupt related definitions */ |
| #define SVC_GROUP_SHIFT 4 |
| #define SVC_GROUP_MASK 0xf |
| #define SVC_NUM_MASK 0xf |
| #define SVC_GROUP(x) ((x >> SVC_GROUP_SHIFT) & \ |
| SVC_GROUP_MASK) |
| |
| #define EINT12CON_REG 0x200 |
| #define EINT12MASK_REG 0x240 |
| #define EINT12PEND_REG 0x260 |
| |
| #define EINT_OFFS(i) ((i) % (2 * EINT_MAX_PER_GROUP)) |
| #define EINT_GROUP(i) ((i) / EINT_MAX_PER_GROUP) |
| #define EINT_REG(g) (4 * ((g) / 2)) |
| |
| #define EINTCON_REG(i) (EINT12CON_REG + EINT_REG(EINT_GROUP(i))) |
| #define EINTMASK_REG(i) (EINT12MASK_REG + EINT_REG(EINT_GROUP(i))) |
| #define EINTPEND_REG(i) (EINT12PEND_REG + EINT_REG(EINT_GROUP(i))) |
| |
| #define SERVICE_REG 0x284 |
| #define SERVICEPEND_REG 0x288 |
| |
| #define EINT0CON0_REG 0x900 |
| #define EINT0MASK_REG 0x920 |
| #define EINT0PEND_REG 0x924 |
| |
| /* S3C64xx specific external interrupt trigger types */ |
| #define EINT_LEVEL_LOW 0 |
| #define EINT_LEVEL_HIGH 1 |
| #define EINT_EDGE_FALLING 2 |
| #define EINT_EDGE_RISING 4 |
| #define EINT_EDGE_BOTH 6 |
| #define EINT_CON_MASK 0xF |
| #define EINT_CON_LEN 4 |
| |
| static const struct samsung_pin_bank_type bank_type_4bit_off = { |
| .fld_width = { 4, 1, 2, 0, 2, 2, }, |
| .reg_offset = { 0x00, 0x04, 0x08, 0, 0x0c, 0x10, }, |
| }; |
| |
| static const struct samsung_pin_bank_type bank_type_4bit_alive = { |
| .fld_width = { 4, 1, 2, }, |
| .reg_offset = { 0x00, 0x04, 0x08, }, |
| }; |
| |
| static const struct samsung_pin_bank_type bank_type_4bit2_off = { |
| .fld_width = { 4, 1, 2, 0, 2, 2, }, |
| .reg_offset = { 0x00, 0x08, 0x0c, 0, 0x10, 0x14, }, |
| }; |
| |
| static const struct samsung_pin_bank_type bank_type_4bit2_alive = { |
| .fld_width = { 4, 1, 2, }, |
| .reg_offset = { 0x00, 0x08, 0x0c, }, |
| }; |
| |
| static const struct samsung_pin_bank_type bank_type_2bit_off = { |
| .fld_width = { 2, 1, 2, 0, 2, 2, }, |
| .reg_offset = { 0x00, 0x04, 0x08, 0, 0x0c, 0x10, }, |
| }; |
| |
| static const struct samsung_pin_bank_type bank_type_2bit_alive = { |
| .fld_width = { 2, 1, 2, }, |
| .reg_offset = { 0x00, 0x04, 0x08, }, |
| }; |
| |
| #define PIN_BANK_4BIT(pins, reg, id) \ |
| { \ |
| .type = &bank_type_4bit_off, \ |
| .pctl_offset = reg, \ |
| .nr_pins = pins, \ |
| .eint_type = EINT_TYPE_NONE, \ |
| .name = id \ |
| } |
| |
| #define PIN_BANK_4BIT_EINTG(pins, reg, id, eoffs) \ |
| { \ |
| .type = &bank_type_4bit_off, \ |
| .pctl_offset = reg, \ |
| .nr_pins = pins, \ |
| .eint_type = EINT_TYPE_GPIO, \ |
| .eint_func = 7, \ |
| .eint_mask = (1 << (pins)) - 1, \ |
| .eint_offset = eoffs, \ |
| .name = id \ |
| } |
| |
| #define PIN_BANK_4BIT_EINTW(pins, reg, id, eoffs, emask) \ |
| { \ |
| .type = &bank_type_4bit_alive,\ |
| .pctl_offset = reg, \ |
| .nr_pins = pins, \ |
| .eint_type = EINT_TYPE_WKUP, \ |
| .eint_func = 3, \ |
| .eint_mask = emask, \ |
| .eint_offset = eoffs, \ |
| .name = id \ |
| } |
| |
| #define PIN_BANK_4BIT2_EINTG(pins, reg, id, eoffs) \ |
| { \ |
| .type = &bank_type_4bit2_off, \ |
| .pctl_offset = reg, \ |
| .nr_pins = pins, \ |
| .eint_type = EINT_TYPE_GPIO, \ |
| .eint_func = 7, \ |
| .eint_mask = (1 << (pins)) - 1, \ |
| .eint_offset = eoffs, \ |
| .name = id \ |
| } |
| |
| #define PIN_BANK_4BIT2_EINTW(pins, reg, id, eoffs, emask) \ |
| { \ |
| .type = &bank_type_4bit2_alive,\ |
| .pctl_offset = reg, \ |
| .nr_pins = pins, \ |
| .eint_type = EINT_TYPE_WKUP, \ |
| .eint_func = 3, \ |
| .eint_mask = emask, \ |
| .eint_offset = eoffs, \ |
| .name = id \ |
| } |
| |
| #define PIN_BANK_4BIT2_ALIVE(pins, reg, id) \ |
| { \ |
| .type = &bank_type_4bit2_alive,\ |
| .pctl_offset = reg, \ |
| .nr_pins = pins, \ |
| .eint_type = EINT_TYPE_NONE, \ |
| .name = id \ |
| } |
| |
| #define PIN_BANK_2BIT(pins, reg, id) \ |
| { \ |
| .type = &bank_type_2bit_off, \ |
| .pctl_offset = reg, \ |
| .nr_pins = pins, \ |
| .eint_type = EINT_TYPE_NONE, \ |
| .name = id \ |
| } |
| |
| #define PIN_BANK_2BIT_EINTG(pins, reg, id, eoffs, emask) \ |
| { \ |
| .type = &bank_type_2bit_off, \ |
| .pctl_offset = reg, \ |
| .nr_pins = pins, \ |
| .eint_type = EINT_TYPE_GPIO, \ |
| .eint_func = 3, \ |
| .eint_mask = emask, \ |
| .eint_offset = eoffs, \ |
| .name = id \ |
| } |
| |
| #define PIN_BANK_2BIT_EINTW(pins, reg, id, eoffs) \ |
| { \ |
| .type = &bank_type_2bit_alive,\ |
| .pctl_offset = reg, \ |
| .nr_pins = pins, \ |
| .eint_type = EINT_TYPE_WKUP, \ |
| .eint_func = 2, \ |
| .eint_mask = (1 << (pins)) - 1, \ |
| .eint_offset = eoffs, \ |
| .name = id \ |
| } |
| |
| /** |
| * struct s3c64xx_eint0_data: EINT0 common data |
| * @drvdata: pin controller driver data |
| * @domains: IRQ domains of particular EINT0 interrupts |
| * @pins: pin offsets inside of banks of particular EINT0 interrupts |
| */ |
| struct s3c64xx_eint0_data { |
| struct samsung_pinctrl_drv_data *drvdata; |
| struct irq_domain *domains[NUM_EINT0]; |
| u8 pins[NUM_EINT0]; |
| }; |
| |
| /** |
| * struct s3c64xx_eint0_domain_data: EINT0 per-domain data |
| * @bank: pin bank related to the domain |
| * @eints: EINT0 interrupts related to the domain |
| */ |
| struct s3c64xx_eint0_domain_data { |
| struct samsung_pin_bank *bank; |
| u8 eints[]; |
| }; |
| |
| /** |
| * struct s3c64xx_eint_gpio_data: GPIO EINT data |
| * @drvdata: pin controller driver data |
| * @domains: array of domains related to EINT interrupt groups |
| */ |
| struct s3c64xx_eint_gpio_data { |
| struct samsung_pinctrl_drv_data *drvdata; |
| struct irq_domain *domains[]; |
| }; |
| |
| /* |
| * Common functions for S3C64xx EINT configuration |
| */ |
| |
| static int s3c64xx_irq_get_trigger(unsigned int type) |
| { |
| int trigger; |
| |
| switch (type) { |
| case IRQ_TYPE_EDGE_RISING: |
| trigger = EINT_EDGE_RISING; |
| break; |
| case IRQ_TYPE_EDGE_FALLING: |
| trigger = EINT_EDGE_FALLING; |
| break; |
| case IRQ_TYPE_EDGE_BOTH: |
| trigger = EINT_EDGE_BOTH; |
| break; |
| case IRQ_TYPE_LEVEL_HIGH: |
| trigger = EINT_LEVEL_HIGH; |
| break; |
| case IRQ_TYPE_LEVEL_LOW: |
| trigger = EINT_LEVEL_LOW; |
| break; |
| default: |
| return -EINVAL; |
| } |
| |
| return trigger; |
| } |
| |
| static void s3c64xx_irq_set_handler(unsigned int irq, unsigned int type) |
| { |
| /* Edge- and level-triggered interrupts need different handlers */ |
| if (type & IRQ_TYPE_EDGE_BOTH) |
| __irq_set_handler_locked(irq, handle_edge_irq); |
| else |
| __irq_set_handler_locked(irq, handle_level_irq); |
| } |
| |
| static void s3c64xx_irq_set_function(struct samsung_pinctrl_drv_data *d, |
| struct samsung_pin_bank *bank, int pin) |
| { |
| const struct samsung_pin_bank_type *bank_type = bank->type; |
| unsigned long flags; |
| void __iomem *reg; |
| u8 shift; |
| u32 mask; |
| u32 val; |
| |
| /* Make sure that pin is configured as interrupt */ |
| reg = d->virt_base + bank->pctl_offset; |
| shift = pin; |
| if (bank_type->fld_width[PINCFG_TYPE_FUNC] * shift >= 32) { |
| /* 4-bit bank type with 2 con regs */ |
| reg += 4; |
| shift -= 8; |
| } |
| |
| shift = shift * bank_type->fld_width[PINCFG_TYPE_FUNC]; |
| mask = (1 << bank_type->fld_width[PINCFG_TYPE_FUNC]) - 1; |
| |
| spin_lock_irqsave(&bank->slock, flags); |
| |
| val = readl(reg); |
| val &= ~(mask << shift); |
| val |= bank->eint_func << shift; |
| writel(val, reg); |
| |
| spin_unlock_irqrestore(&bank->slock, flags); |
| } |
| |
| /* |
| * Functions for EINT GPIO configuration (EINT groups 1-9) |
| */ |
| |
| static inline void s3c64xx_gpio_irq_set_mask(struct irq_data *irqd, bool mask) |
| { |
| struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd); |
| struct samsung_pinctrl_drv_data *d = bank->drvdata; |
| unsigned char index = EINT_OFFS(bank->eint_offset) + irqd->hwirq; |
| void __iomem *reg = d->virt_base + EINTMASK_REG(bank->eint_offset); |
| u32 val; |
| |
| val = readl(reg); |
| if (mask) |
| val |= 1 << index; |
| else |
| val &= ~(1 << index); |
| writel(val, reg); |
| } |
| |
| static void s3c64xx_gpio_irq_unmask(struct irq_data *irqd) |
| { |
| s3c64xx_gpio_irq_set_mask(irqd, false); |
| } |
| |
| static void s3c64xx_gpio_irq_mask(struct irq_data *irqd) |
| { |
| s3c64xx_gpio_irq_set_mask(irqd, true); |
| } |
| |
| static void s3c64xx_gpio_irq_ack(struct irq_data *irqd) |
| { |
| struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd); |
| struct samsung_pinctrl_drv_data *d = bank->drvdata; |
| unsigned char index = EINT_OFFS(bank->eint_offset) + irqd->hwirq; |
| void __iomem *reg = d->virt_base + EINTPEND_REG(bank->eint_offset); |
| |
| writel(1 << index, reg); |
| } |
| |
| static int s3c64xx_gpio_irq_set_type(struct irq_data *irqd, unsigned int type) |
| { |
| struct samsung_pin_bank *bank = irq_data_get_irq_chip_data(irqd); |
| struct samsung_pinctrl_drv_data *d = bank->drvdata; |
| void __iomem *reg; |
| int trigger; |
| u8 shift; |
| u32 val; |
| |
| trigger = s3c64xx_irq_get_trigger(type); |
| if (trigger < 0) { |
| pr_err("unsupported external interrupt type\n"); |
| return -EINVAL; |
| } |
| |
| s3c64xx_irq_set_handler(irqd->irq, type); |
| |
| /* Set up interrupt trigger */ |
| reg = d->virt_base + EINTCON_REG(bank->eint_offset); |
| shift = EINT_OFFS(bank->eint_offset) + irqd->hwirq; |
| shift = 4 * (shift / 4); /* 4 EINTs per trigger selector */ |
| |
| val = readl(reg); |
| val &= ~(EINT_CON_MASK << shift); |
| val |= trigger << shift; |
| writel(val, reg); |
| |
| s3c64xx_irq_set_function(d, bank, irqd->hwirq); |
| |
| return 0; |
| } |
| |
| /* |
| * irq_chip for gpio interrupts. |
| */ |
| static struct irq_chip s3c64xx_gpio_irq_chip = { |
| .name = "GPIO", |
| .irq_unmask = s3c64xx_gpio_irq_unmask, |
| .irq_mask = s3c64xx_gpio_irq_mask, |
| .irq_ack = s3c64xx_gpio_irq_ack, |
| .irq_set_type = s3c64xx_gpio_irq_set_type, |
| }; |
| |
| static int s3c64xx_gpio_irq_map(struct irq_domain *h, unsigned int virq, |
| irq_hw_number_t hw) |
| { |
| struct samsung_pin_bank *bank = h->host_data; |
| |
| if (!(bank->eint_mask & (1 << hw))) |
| return -EINVAL; |
| |
| irq_set_chip_and_handler(virq, |
| &s3c64xx_gpio_irq_chip, handle_level_irq); |
| irq_set_chip_data(virq, bank); |
| set_irq_flags(virq, IRQF_VALID); |
| |
| return 0; |
| } |
| |
| /* |
| * irq domain callbacks for external gpio interrupt controller. |
| */ |
| static const struct irq_domain_ops s3c64xx_gpio_irqd_ops = { |
| .map = s3c64xx_gpio_irq_map, |
| .xlate = irq_domain_xlate_twocell, |
| }; |
| |
| static void s3c64xx_eint_gpio_irq(unsigned int irq, struct irq_desc *desc) |
| { |
| struct irq_chip *chip = irq_get_chip(irq); |
| struct s3c64xx_eint_gpio_data *data = irq_get_handler_data(irq); |
| struct samsung_pinctrl_drv_data *drvdata = data->drvdata; |
| |
| chained_irq_enter(chip, desc); |
| |
| do { |
| unsigned int svc; |
| unsigned int group; |
| unsigned int pin; |
| unsigned int virq; |
| |
| svc = readl(drvdata->virt_base + SERVICE_REG); |
| group = SVC_GROUP(svc); |
| pin = svc & SVC_NUM_MASK; |
| |
| if (!group) |
| break; |
| |
| /* Group 1 is used for two pin banks */ |
| if (group == 1) { |
| if (pin < 8) |
| group = 0; |
| else |
| pin -= 8; |
| } |
| |
| virq = irq_linear_revmap(data->domains[group], pin); |
| /* |
| * Something must be really wrong if an unmapped EINT |
| * was unmasked... |
| */ |
| BUG_ON(!virq); |
| |
| generic_handle_irq(virq); |
| } while (1); |
| |
| chained_irq_exit(chip, desc); |
| } |
| |
| /** |
| * s3c64xx_eint_gpio_init() - setup handling of external gpio interrupts. |
| * @d: driver data of samsung pinctrl driver. |
| */ |
| static int s3c64xx_eint_gpio_init(struct samsung_pinctrl_drv_data *d) |
| { |
| struct s3c64xx_eint_gpio_data *data; |
| struct samsung_pin_bank *bank; |
| struct device *dev = d->dev; |
| unsigned int nr_domains; |
| unsigned int i; |
| |
| if (!d->irq) { |
| dev_err(dev, "irq number not available\n"); |
| return -EINVAL; |
| } |
| |
| nr_domains = 0; |
| bank = d->pin_banks; |
| for (i = 0; i < d->nr_banks; ++i, ++bank) { |
| unsigned int nr_eints; |
| unsigned int mask; |
| |
| if (bank->eint_type != EINT_TYPE_GPIO) |
| continue; |
| |
| mask = bank->eint_mask; |
| nr_eints = fls(mask); |
| |
| bank->irq_domain = irq_domain_add_linear(bank->of_node, |
| nr_eints, &s3c64xx_gpio_irqd_ops, bank); |
| if (!bank->irq_domain) { |
| dev_err(dev, "gpio irq domain add failed\n"); |
| return -ENXIO; |
| } |
| |
| ++nr_domains; |
| } |
| |
| data = devm_kzalloc(dev, sizeof(*data) |
| + nr_domains * sizeof(*data->domains), GFP_KERNEL); |
| if (!data) { |
| dev_err(dev, "failed to allocate handler data\n"); |
| return -ENOMEM; |
| } |
| data->drvdata = d; |
| |
| bank = d->pin_banks; |
| nr_domains = 0; |
| for (i = 0; i < d->nr_banks; ++i, ++bank) { |
| if (bank->eint_type != EINT_TYPE_GPIO) |
| continue; |
| |
| data->domains[nr_domains++] = bank->irq_domain; |
| } |
| |
| irq_set_chained_handler(d->irq, s3c64xx_eint_gpio_irq); |
| irq_set_handler_data(d->irq, data); |
| |
| return 0; |
| } |
| |
| /* |
| * Functions for configuration of EINT0 wake-up interrupts |
| */ |
| |
| static inline void s3c64xx_eint0_irq_set_mask(struct irq_data *irqd, bool mask) |
| { |
| struct s3c64xx_eint0_domain_data *ddata = |
| irq_data_get_irq_chip_data(irqd); |
| struct samsung_pinctrl_drv_data *d = ddata->bank->drvdata; |
| u32 val; |
| |
| val = readl(d->virt_base + EINT0MASK_REG); |
| if (mask) |
| val |= 1 << ddata->eints[irqd->hwirq]; |
| else |
| val &= ~(1 << ddata->eints[irqd->hwirq]); |
| writel(val, d->virt_base + EINT0MASK_REG); |
| } |
| |
| static void s3c64xx_eint0_irq_unmask(struct irq_data *irqd) |
| { |
| s3c64xx_eint0_irq_set_mask(irqd, false); |
| } |
| |
| static void s3c64xx_eint0_irq_mask(struct irq_data *irqd) |
| { |
| s3c64xx_eint0_irq_set_mask(irqd, true); |
| } |
| |
| static void s3c64xx_eint0_irq_ack(struct irq_data *irqd) |
| { |
| struct s3c64xx_eint0_domain_data *ddata = |
| irq_data_get_irq_chip_data(irqd); |
| struct samsung_pinctrl_drv_data *d = ddata->bank->drvdata; |
| |
| writel(1 << ddata->eints[irqd->hwirq], |
| d->virt_base + EINT0PEND_REG); |
| } |
| |
| static int s3c64xx_eint0_irq_set_type(struct irq_data *irqd, unsigned int type) |
| { |
| struct s3c64xx_eint0_domain_data *ddata = |
| irq_data_get_irq_chip_data(irqd); |
| struct samsung_pin_bank *bank = ddata->bank; |
| struct samsung_pinctrl_drv_data *d = bank->drvdata; |
| void __iomem *reg; |
| int trigger; |
| u8 shift; |
| u32 val; |
| |
| trigger = s3c64xx_irq_get_trigger(type); |
| if (trigger < 0) { |
| pr_err("unsupported external interrupt type\n"); |
| return -EINVAL; |
| } |
| |
| s3c64xx_irq_set_handler(irqd->irq, type); |
| |
| /* Set up interrupt trigger */ |
| reg = d->virt_base + EINT0CON0_REG; |
| shift = ddata->eints[irqd->hwirq]; |
| if (shift >= EINT_MAX_PER_REG) { |
| reg += 4; |
| shift -= EINT_MAX_PER_REG; |
| } |
| shift = EINT_CON_LEN * (shift / 2); |
| |
| val = readl(reg); |
| val &= ~(EINT_CON_MASK << shift); |
| val |= trigger << shift; |
| writel(val, reg); |
| |
| s3c64xx_irq_set_function(d, bank, irqd->hwirq); |
| |
| return 0; |
| } |
| |
| /* |
| * irq_chip for wakeup interrupts |
| */ |
| static struct irq_chip s3c64xx_eint0_irq_chip = { |
| .name = "EINT0", |
| .irq_unmask = s3c64xx_eint0_irq_unmask, |
| .irq_mask = s3c64xx_eint0_irq_mask, |
| .irq_ack = s3c64xx_eint0_irq_ack, |
| .irq_set_type = s3c64xx_eint0_irq_set_type, |
| }; |
| |
| static inline void s3c64xx_irq_demux_eint(unsigned int irq, |
| struct irq_desc *desc, u32 range) |
| { |
| struct irq_chip *chip = irq_get_chip(irq); |
| struct s3c64xx_eint0_data *data = irq_get_handler_data(irq); |
| struct samsung_pinctrl_drv_data *drvdata = data->drvdata; |
| unsigned int pend, mask; |
| |
| chained_irq_enter(chip, desc); |
| |
| pend = readl(drvdata->virt_base + EINT0PEND_REG); |
| mask = readl(drvdata->virt_base + EINT0MASK_REG); |
| |
| pend = pend & range & ~mask; |
| pend &= range; |
| |
| while (pend) { |
| unsigned int virq; |
| |
| irq = fls(pend) - 1; |
| pend &= ~(1 << irq); |
| |
| virq = irq_linear_revmap(data->domains[irq], data->pins[irq]); |
| /* |
| * Something must be really wrong if an unmapped EINT |
| * was unmasked... |
| */ |
| BUG_ON(!virq); |
| |
| generic_handle_irq(virq); |
| } |
| |
| chained_irq_exit(chip, desc); |
| } |
| |
| static void s3c64xx_demux_eint0_3(unsigned int irq, struct irq_desc *desc) |
| { |
| s3c64xx_irq_demux_eint(irq, desc, 0xf); |
| } |
| |
| static void s3c64xx_demux_eint4_11(unsigned int irq, struct irq_desc *desc) |
| { |
| s3c64xx_irq_demux_eint(irq, desc, 0xff0); |
| } |
| |
| static void s3c64xx_demux_eint12_19(unsigned int irq, struct irq_desc *desc) |
| { |
| s3c64xx_irq_demux_eint(irq, desc, 0xff000); |
| } |
| |
| static void s3c64xx_demux_eint20_27(unsigned int irq, struct irq_desc *desc) |
| { |
| s3c64xx_irq_demux_eint(irq, desc, 0xff00000); |
| } |
| |
| static irq_flow_handler_t s3c64xx_eint0_handlers[NUM_EINT0_IRQ] = { |
| s3c64xx_demux_eint0_3, |
| s3c64xx_demux_eint4_11, |
| s3c64xx_demux_eint12_19, |
| s3c64xx_demux_eint20_27, |
| }; |
| |
| static int s3c64xx_eint0_irq_map(struct irq_domain *h, unsigned int virq, |
| irq_hw_number_t hw) |
| { |
| struct s3c64xx_eint0_domain_data *ddata = h->host_data; |
| struct samsung_pin_bank *bank = ddata->bank; |
| |
| if (!(bank->eint_mask & (1 << hw))) |
| return -EINVAL; |
| |
| irq_set_chip_and_handler(virq, |
| &s3c64xx_eint0_irq_chip, handle_level_irq); |
| irq_set_chip_data(virq, ddata); |
| set_irq_flags(virq, IRQF_VALID); |
| |
| return 0; |
| } |
| |
| /* |
| * irq domain callbacks for external wakeup interrupt controller. |
| */ |
| static const struct irq_domain_ops s3c64xx_eint0_irqd_ops = { |
| .map = s3c64xx_eint0_irq_map, |
| .xlate = irq_domain_xlate_twocell, |
| }; |
| |
| /* list of external wakeup controllers supported */ |
| static const struct of_device_id s3c64xx_eint0_irq_ids[] = { |
| { .compatible = "samsung,s3c64xx-wakeup-eint", }, |
| { } |
| }; |
| |
| /** |
| * s3c64xx_eint_eint0_init() - setup handling of external wakeup interrupts. |
| * @d: driver data of samsung pinctrl driver. |
| */ |
| static int s3c64xx_eint_eint0_init(struct samsung_pinctrl_drv_data *d) |
| { |
| struct device *dev = d->dev; |
| struct device_node *eint0_np = NULL; |
| struct device_node *np; |
| struct samsung_pin_bank *bank; |
| struct s3c64xx_eint0_data *data; |
| unsigned int i; |
| |
| for_each_child_of_node(dev->of_node, np) { |
| if (of_match_node(s3c64xx_eint0_irq_ids, np)) { |
| eint0_np = np; |
| break; |
| } |
| } |
| if (!eint0_np) |
| return -ENODEV; |
| |
| data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); |
| if (!data) { |
| dev_err(dev, "could not allocate memory for wkup eint data\n"); |
| return -ENOMEM; |
| } |
| data->drvdata = d; |
| |
| for (i = 0; i < NUM_EINT0_IRQ; ++i) { |
| unsigned int irq; |
| |
| irq = irq_of_parse_and_map(eint0_np, i); |
| if (!irq) { |
| dev_err(dev, "failed to get wakeup EINT IRQ %d\n", i); |
| return -ENXIO; |
| } |
| |
| irq_set_chained_handler(irq, s3c64xx_eint0_handlers[i]); |
| irq_set_handler_data(irq, data); |
| } |
| |
| bank = d->pin_banks; |
| for (i = 0; i < d->nr_banks; ++i, ++bank) { |
| struct s3c64xx_eint0_domain_data *ddata; |
| unsigned int nr_eints; |
| unsigned int mask; |
| unsigned int irq; |
| unsigned int pin; |
| |
| if (bank->eint_type != EINT_TYPE_WKUP) |
| continue; |
| |
| mask = bank->eint_mask; |
| nr_eints = fls(mask); |
| |
| ddata = devm_kzalloc(dev, |
| sizeof(*ddata) + nr_eints, GFP_KERNEL); |
| if (!ddata) { |
| dev_err(dev, "failed to allocate domain data\n"); |
| return -ENOMEM; |
| } |
| ddata->bank = bank; |
| |
| bank->irq_domain = irq_domain_add_linear(bank->of_node, |
| nr_eints, &s3c64xx_eint0_irqd_ops, ddata); |
| if (!bank->irq_domain) { |
| dev_err(dev, "wkup irq domain add failed\n"); |
| return -ENXIO; |
| } |
| |
| irq = bank->eint_offset; |
| mask = bank->eint_mask; |
| for (pin = 0; mask; ++pin, mask >>= 1) { |
| if (!(mask & 1)) |
| continue; |
| data->domains[irq] = bank->irq_domain; |
| data->pins[irq] = pin; |
| ddata->eints[pin] = irq; |
| ++irq; |
| } |
| } |
| |
| return 0; |
| } |
| |
| /* pin banks of s3c64xx pin-controller 0 */ |
| static const struct samsung_pin_bank_data s3c64xx_pin_banks0[] __initconst = { |
| PIN_BANK_4BIT_EINTG(8, 0x000, "gpa", 0), |
| PIN_BANK_4BIT_EINTG(7, 0x020, "gpb", 8), |
| PIN_BANK_4BIT_EINTG(8, 0x040, "gpc", 16), |
| PIN_BANK_4BIT_EINTG(5, 0x060, "gpd", 32), |
| PIN_BANK_4BIT(5, 0x080, "gpe"), |
| PIN_BANK_2BIT_EINTG(16, 0x0a0, "gpf", 48, 0x3fff), |
| PIN_BANK_4BIT_EINTG(7, 0x0c0, "gpg", 64), |
| PIN_BANK_4BIT2_EINTG(10, 0x0e0, "gph", 80), |
| PIN_BANK_2BIT(16, 0x100, "gpi"), |
| PIN_BANK_2BIT(12, 0x120, "gpj"), |
| PIN_BANK_4BIT2_ALIVE(16, 0x800, "gpk"), |
| PIN_BANK_4BIT2_EINTW(15, 0x810, "gpl", 16, 0x7f00), |
| PIN_BANK_4BIT_EINTW(6, 0x820, "gpm", 23, 0x1f), |
| PIN_BANK_2BIT_EINTW(16, 0x830, "gpn", 0), |
| PIN_BANK_2BIT_EINTG(16, 0x140, "gpo", 96, 0xffff), |
| PIN_BANK_2BIT_EINTG(15, 0x160, "gpp", 112, 0x7fff), |
| PIN_BANK_2BIT_EINTG(9, 0x180, "gpq", 128, 0x1ff), |
| }; |
| |
| /* |
| * Samsung pinctrl driver data for S3C64xx SoC. S3C64xx SoC includes |
| * one gpio/pin-mux/pinconfig controller. |
| */ |
| const struct samsung_pin_ctrl s3c64xx_pin_ctrl[] __initconst = { |
| { |
| /* pin-controller instance 1 data */ |
| .pin_banks = s3c64xx_pin_banks0, |
| .nr_banks = ARRAY_SIZE(s3c64xx_pin_banks0), |
| .eint_gpio_init = s3c64xx_eint_gpio_init, |
| .eint_wkup_init = s3c64xx_eint_eint0_init, |
| }, |
| }; |