| // SPDX-License-Identifier: GPL-2.0 | |
| /* | |
| * Copyright (C) 2018 Spreadtrum Communications Inc. | |
| * Copyright (C) 2018 Linaro Ltd. | |
| */ | |
| #include <linux/bitops.h> | |
| #include <linux/gpio/driver.h> | |
| #include <linux/interrupt.h> | |
| #include <linux/kernel.h> | |
| #include <linux/module.h> | |
| #include <linux/notifier.h> | |
| #include <linux/platform_device.h> | |
| #include <linux/property.h> | |
| #include <linux/spinlock.h> | |
| /* EIC registers definition */ | |
| #define SPRD_EIC_DBNC_DATA 0x0 | |
| #define SPRD_EIC_DBNC_DMSK 0x4 | |
| #define SPRD_EIC_DBNC_IEV 0x14 | |
| #define SPRD_EIC_DBNC_IE 0x18 | |
| #define SPRD_EIC_DBNC_RIS 0x1c | |
| #define SPRD_EIC_DBNC_MIS 0x20 | |
| #define SPRD_EIC_DBNC_IC 0x24 | |
| #define SPRD_EIC_DBNC_TRIG 0x28 | |
| #define SPRD_EIC_DBNC_CTRL0 0x40 | |
| #define SPRD_EIC_LATCH_INTEN 0x0 | |
| #define SPRD_EIC_LATCH_INTRAW 0x4 | |
| #define SPRD_EIC_LATCH_INTMSK 0x8 | |
| #define SPRD_EIC_LATCH_INTCLR 0xc | |
| #define SPRD_EIC_LATCH_INTPOL 0x10 | |
| #define SPRD_EIC_LATCH_INTMODE 0x14 | |
| #define SPRD_EIC_ASYNC_INTIE 0x0 | |
| #define SPRD_EIC_ASYNC_INTRAW 0x4 | |
| #define SPRD_EIC_ASYNC_INTMSK 0x8 | |
| #define SPRD_EIC_ASYNC_INTCLR 0xc | |
| #define SPRD_EIC_ASYNC_INTMODE 0x10 | |
| #define SPRD_EIC_ASYNC_INTBOTH 0x14 | |
| #define SPRD_EIC_ASYNC_INTPOL 0x18 | |
| #define SPRD_EIC_ASYNC_DATA 0x1c | |
| #define SPRD_EIC_SYNC_INTIE 0x0 | |
| #define SPRD_EIC_SYNC_INTRAW 0x4 | |
| #define SPRD_EIC_SYNC_INTMSK 0x8 | |
| #define SPRD_EIC_SYNC_INTCLR 0xc | |
| #define SPRD_EIC_SYNC_INTMODE 0x10 | |
| #define SPRD_EIC_SYNC_INTBOTH 0x14 | |
| #define SPRD_EIC_SYNC_INTPOL 0x18 | |
| #define SPRD_EIC_SYNC_DATA 0x1c | |
| /* | |
| * The digital-chip EIC controller can support maximum 3 banks, and each bank | |
| * contains 8 EICs. | |
| */ | |
| #define SPRD_EIC_MAX_BANK 3 | |
| #define SPRD_EIC_PER_BANK_NR 8 | |
| #define SPRD_EIC_DATA_MASK GENMASK(7, 0) | |
| #define SPRD_EIC_BIT(x) ((x) & (SPRD_EIC_PER_BANK_NR - 1)) | |
| #define SPRD_EIC_DBNC_MASK GENMASK(11, 0) | |
| /* | |
| * The Spreadtrum EIC (external interrupt controller) can be used only in | |
| * input mode to generate interrupts if detecting input signals. | |
| * | |
| * The Spreadtrum digital-chip EIC controller contains 4 sub-modules: | |
| * debounce EIC, latch EIC, async EIC and sync EIC, | |
| * | |
| * The debounce EIC is used to capture the input signals' stable status | |
| * (millisecond resolution) and a single-trigger mechanism is introduced | |
| * into this sub-module to enhance the input event detection reliability. | |
| * The debounce range is from 1ms to 4s with a step size of 1ms. | |
| * | |
| * The latch EIC is used to latch some special power down signals and | |
| * generate interrupts, since the latch EIC does not depend on the APB clock | |
| * to capture signals. | |
| * | |
| * The async EIC uses a 32k clock to capture the short signals (microsecond | |
| * resolution) to generate interrupts by level or edge trigger. | |
| * | |
| * The EIC-sync is similar with GPIO's input function, which is a synchronized | |
| * signal input register. | |
| */ | |
| enum sprd_eic_type { | |
| SPRD_EIC_DEBOUNCE, | |
| SPRD_EIC_LATCH, | |
| SPRD_EIC_ASYNC, | |
| SPRD_EIC_SYNC, | |
| SPRD_EIC_MAX, | |
| }; | |
| struct sprd_eic { | |
| struct gpio_chip chip; | |
| struct notifier_block irq_nb; | |
| void __iomem *base[SPRD_EIC_MAX_BANK]; | |
| enum sprd_eic_type type; | |
| raw_spinlock_t lock; | |
| int irq; | |
| }; | |
| static ATOMIC_NOTIFIER_HEAD(sprd_eic_irq_notifier); | |
| static struct sprd_eic *to_sprd_eic(struct notifier_block *nb) | |
| { | |
| return container_of(nb, struct sprd_eic, irq_nb); | |
| } | |
| struct sprd_eic_variant_data { | |
| enum sprd_eic_type type; | |
| }; | |
| static const char *sprd_eic_label_name[SPRD_EIC_MAX] = { | |
| "eic-debounce", "eic-latch", "eic-async", | |
| "eic-sync", | |
| }; | |
| static const struct sprd_eic_variant_data sc9860_eic_dbnc_data = { | |
| .type = SPRD_EIC_DEBOUNCE, | |
| }; | |
| static const struct sprd_eic_variant_data sc9860_eic_latch_data = { | |
| .type = SPRD_EIC_LATCH, | |
| }; | |
| static const struct sprd_eic_variant_data sc9860_eic_async_data = { | |
| .type = SPRD_EIC_ASYNC, | |
| }; | |
| static const struct sprd_eic_variant_data sc9860_eic_sync_data = { | |
| .type = SPRD_EIC_SYNC, | |
| }; | |
| static inline void __iomem *sprd_eic_offset_base(struct sprd_eic *sprd_eic, | |
| unsigned int bank) | |
| { | |
| if (bank >= SPRD_EIC_MAX_BANK) | |
| return NULL; | |
| return sprd_eic->base[bank]; | |
| } | |
| static void sprd_eic_update(struct gpio_chip *chip, unsigned int offset, | |
| u16 reg, unsigned int val) | |
| { | |
| struct sprd_eic *sprd_eic = gpiochip_get_data(chip); | |
| void __iomem *base = | |
| sprd_eic_offset_base(sprd_eic, offset / SPRD_EIC_PER_BANK_NR); | |
| unsigned long flags; | |
| u32 tmp; | |
| raw_spin_lock_irqsave(&sprd_eic->lock, flags); | |
| tmp = readl_relaxed(base + reg); | |
| if (val) | |
| tmp |= BIT(SPRD_EIC_BIT(offset)); | |
| else | |
| tmp &= ~BIT(SPRD_EIC_BIT(offset)); | |
| writel_relaxed(tmp, base + reg); | |
| raw_spin_unlock_irqrestore(&sprd_eic->lock, flags); | |
| } | |
| static int sprd_eic_read(struct gpio_chip *chip, unsigned int offset, u16 reg) | |
| { | |
| struct sprd_eic *sprd_eic = gpiochip_get_data(chip); | |
| void __iomem *base = | |
| sprd_eic_offset_base(sprd_eic, offset / SPRD_EIC_PER_BANK_NR); | |
| return !!(readl_relaxed(base + reg) & BIT(SPRD_EIC_BIT(offset))); | |
| } | |
| static int sprd_eic_request(struct gpio_chip *chip, unsigned int offset) | |
| { | |
| sprd_eic_update(chip, offset, SPRD_EIC_DBNC_DMSK, 1); | |
| return 0; | |
| } | |
| static void sprd_eic_free(struct gpio_chip *chip, unsigned int offset) | |
| { | |
| sprd_eic_update(chip, offset, SPRD_EIC_DBNC_DMSK, 0); | |
| } | |
| static int sprd_eic_get(struct gpio_chip *chip, unsigned int offset) | |
| { | |
| struct sprd_eic *sprd_eic = gpiochip_get_data(chip); | |
| switch (sprd_eic->type) { | |
| case SPRD_EIC_DEBOUNCE: | |
| return sprd_eic_read(chip, offset, SPRD_EIC_DBNC_DATA); | |
| case SPRD_EIC_ASYNC: | |
| return sprd_eic_read(chip, offset, SPRD_EIC_ASYNC_DATA); | |
| case SPRD_EIC_SYNC: | |
| return sprd_eic_read(chip, offset, SPRD_EIC_SYNC_DATA); | |
| default: | |
| return -ENOTSUPP; | |
| } | |
| } | |
| static int sprd_eic_direction_input(struct gpio_chip *chip, unsigned int offset) | |
| { | |
| /* EICs are always input, nothing need to do here. */ | |
| return 0; | |
| } | |
| static int sprd_eic_set(struct gpio_chip *chip, unsigned int offset, int value) | |
| { | |
| /* EICs are always input, nothing need to do here. */ | |
| return 0; | |
| } | |
| static int sprd_eic_set_debounce(struct gpio_chip *chip, unsigned int offset, | |
| unsigned int debounce) | |
| { | |
| struct sprd_eic *sprd_eic = gpiochip_get_data(chip); | |
| void __iomem *base = | |
| sprd_eic_offset_base(sprd_eic, offset / SPRD_EIC_PER_BANK_NR); | |
| u32 reg = SPRD_EIC_DBNC_CTRL0 + SPRD_EIC_BIT(offset) * 0x4; | |
| u32 value = readl_relaxed(base + reg) & ~SPRD_EIC_DBNC_MASK; | |
| value |= (debounce / 1000) & SPRD_EIC_DBNC_MASK; | |
| writel_relaxed(value, base + reg); | |
| return 0; | |
| } | |
| static int sprd_eic_set_config(struct gpio_chip *chip, unsigned int offset, | |
| unsigned long config) | |
| { | |
| unsigned long param = pinconf_to_config_param(config); | |
| u32 arg = pinconf_to_config_argument(config); | |
| if (param == PIN_CONFIG_INPUT_DEBOUNCE) | |
| return sprd_eic_set_debounce(chip, offset, arg); | |
| return -ENOTSUPP; | |
| } | |
| static void sprd_eic_irq_mask(struct irq_data *data) | |
| { | |
| struct gpio_chip *chip = irq_data_get_irq_chip_data(data); | |
| struct sprd_eic *sprd_eic = gpiochip_get_data(chip); | |
| u32 offset = irqd_to_hwirq(data); | |
| switch (sprd_eic->type) { | |
| case SPRD_EIC_DEBOUNCE: | |
| sprd_eic_update(chip, offset, SPRD_EIC_DBNC_IE, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_DBNC_TRIG, 0); | |
| break; | |
| case SPRD_EIC_LATCH: | |
| sprd_eic_update(chip, offset, SPRD_EIC_LATCH_INTEN, 0); | |
| break; | |
| case SPRD_EIC_ASYNC: | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTIE, 0); | |
| break; | |
| case SPRD_EIC_SYNC: | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTIE, 0); | |
| break; | |
| default: | |
| dev_err(chip->parent, "Unsupported EIC type.\n"); | |
| } | |
| gpiochip_disable_irq(chip, offset); | |
| } | |
| static void sprd_eic_irq_unmask(struct irq_data *data) | |
| { | |
| struct gpio_chip *chip = irq_data_get_irq_chip_data(data); | |
| struct sprd_eic *sprd_eic = gpiochip_get_data(chip); | |
| u32 offset = irqd_to_hwirq(data); | |
| gpiochip_enable_irq(chip, offset); | |
| switch (sprd_eic->type) { | |
| case SPRD_EIC_DEBOUNCE: | |
| sprd_eic_update(chip, offset, SPRD_EIC_DBNC_IE, 1); | |
| sprd_eic_update(chip, offset, SPRD_EIC_DBNC_TRIG, 1); | |
| break; | |
| case SPRD_EIC_LATCH: | |
| sprd_eic_update(chip, offset, SPRD_EIC_LATCH_INTEN, 1); | |
| break; | |
| case SPRD_EIC_ASYNC: | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTIE, 1); | |
| break; | |
| case SPRD_EIC_SYNC: | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTIE, 1); | |
| break; | |
| default: | |
| dev_err(chip->parent, "Unsupported EIC type.\n"); | |
| } | |
| } | |
| static void sprd_eic_irq_ack(struct irq_data *data) | |
| { | |
| struct gpio_chip *chip = irq_data_get_irq_chip_data(data); | |
| struct sprd_eic *sprd_eic = gpiochip_get_data(chip); | |
| u32 offset = irqd_to_hwirq(data); | |
| switch (sprd_eic->type) { | |
| case SPRD_EIC_DEBOUNCE: | |
| sprd_eic_update(chip, offset, SPRD_EIC_DBNC_IC, 1); | |
| break; | |
| case SPRD_EIC_LATCH: | |
| sprd_eic_update(chip, offset, SPRD_EIC_LATCH_INTCLR, 1); | |
| break; | |
| case SPRD_EIC_ASYNC: | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTCLR, 1); | |
| break; | |
| case SPRD_EIC_SYNC: | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTCLR, 1); | |
| break; | |
| default: | |
| dev_err(chip->parent, "Unsupported EIC type.\n"); | |
| } | |
| } | |
| static int sprd_eic_irq_set_type(struct irq_data *data, unsigned int flow_type) | |
| { | |
| struct gpio_chip *chip = irq_data_get_irq_chip_data(data); | |
| struct sprd_eic *sprd_eic = gpiochip_get_data(chip); | |
| u32 offset = irqd_to_hwirq(data); | |
| int state; | |
| switch (sprd_eic->type) { | |
| case SPRD_EIC_DEBOUNCE: | |
| switch (flow_type) { | |
| case IRQ_TYPE_LEVEL_HIGH: | |
| sprd_eic_update(chip, offset, SPRD_EIC_DBNC_IEV, 1); | |
| sprd_eic_update(chip, offset, SPRD_EIC_DBNC_IC, 1); | |
| break; | |
| case IRQ_TYPE_LEVEL_LOW: | |
| sprd_eic_update(chip, offset, SPRD_EIC_DBNC_IEV, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_DBNC_IC, 1); | |
| break; | |
| case IRQ_TYPE_EDGE_RISING: | |
| case IRQ_TYPE_EDGE_FALLING: | |
| case IRQ_TYPE_EDGE_BOTH: | |
| state = sprd_eic_get(chip, offset); | |
| if (state) { | |
| sprd_eic_update(chip, offset, | |
| SPRD_EIC_DBNC_IEV, 0); | |
| sprd_eic_update(chip, offset, | |
| SPRD_EIC_DBNC_IC, 1); | |
| } else { | |
| sprd_eic_update(chip, offset, | |
| SPRD_EIC_DBNC_IEV, 1); | |
| sprd_eic_update(chip, offset, | |
| SPRD_EIC_DBNC_IC, 1); | |
| } | |
| break; | |
| default: | |
| return -ENOTSUPP; | |
| } | |
| irq_set_handler_locked(data, handle_level_irq); | |
| break; | |
| case SPRD_EIC_LATCH: | |
| switch (flow_type) { | |
| case IRQ_TYPE_LEVEL_HIGH: | |
| sprd_eic_update(chip, offset, SPRD_EIC_LATCH_INTPOL, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_LATCH_INTCLR, 1); | |
| break; | |
| case IRQ_TYPE_LEVEL_LOW: | |
| sprd_eic_update(chip, offset, SPRD_EIC_LATCH_INTPOL, 1); | |
| sprd_eic_update(chip, offset, SPRD_EIC_LATCH_INTCLR, 1); | |
| break; | |
| case IRQ_TYPE_EDGE_RISING: | |
| case IRQ_TYPE_EDGE_FALLING: | |
| case IRQ_TYPE_EDGE_BOTH: | |
| state = sprd_eic_get(chip, offset); | |
| if (state) { | |
| sprd_eic_update(chip, offset, | |
| SPRD_EIC_LATCH_INTPOL, 0); | |
| sprd_eic_update(chip, offset, | |
| SPRD_EIC_LATCH_INTCLR, 1); | |
| } else { | |
| sprd_eic_update(chip, offset, | |
| SPRD_EIC_LATCH_INTPOL, 1); | |
| sprd_eic_update(chip, offset, | |
| SPRD_EIC_LATCH_INTCLR, 1); | |
| } | |
| break; | |
| default: | |
| return -ENOTSUPP; | |
| } | |
| irq_set_handler_locked(data, handle_level_irq); | |
| break; | |
| case SPRD_EIC_ASYNC: | |
| switch (flow_type) { | |
| case IRQ_TYPE_EDGE_RISING: | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTBOTH, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTMODE, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTPOL, 1); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTCLR, 1); | |
| irq_set_handler_locked(data, handle_edge_irq); | |
| break; | |
| case IRQ_TYPE_EDGE_FALLING: | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTBOTH, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTMODE, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTPOL, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTCLR, 1); | |
| irq_set_handler_locked(data, handle_edge_irq); | |
| break; | |
| case IRQ_TYPE_EDGE_BOTH: | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTMODE, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTBOTH, 1); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTCLR, 1); | |
| irq_set_handler_locked(data, handle_edge_irq); | |
| break; | |
| case IRQ_TYPE_LEVEL_HIGH: | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTBOTH, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTMODE, 1); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTPOL, 1); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTCLR, 1); | |
| irq_set_handler_locked(data, handle_level_irq); | |
| break; | |
| case IRQ_TYPE_LEVEL_LOW: | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTBOTH, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTMODE, 1); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTPOL, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_ASYNC_INTCLR, 1); | |
| irq_set_handler_locked(data, handle_level_irq); | |
| break; | |
| default: | |
| return -ENOTSUPP; | |
| } | |
| break; | |
| case SPRD_EIC_SYNC: | |
| switch (flow_type) { | |
| case IRQ_TYPE_EDGE_RISING: | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTBOTH, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTMODE, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTPOL, 1); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTCLR, 1); | |
| irq_set_handler_locked(data, handle_edge_irq); | |
| break; | |
| case IRQ_TYPE_EDGE_FALLING: | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTBOTH, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTMODE, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTPOL, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTCLR, 1); | |
| irq_set_handler_locked(data, handle_edge_irq); | |
| break; | |
| case IRQ_TYPE_EDGE_BOTH: | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTMODE, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTBOTH, 1); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTCLR, 1); | |
| irq_set_handler_locked(data, handle_edge_irq); | |
| break; | |
| case IRQ_TYPE_LEVEL_HIGH: | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTBOTH, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTMODE, 1); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTPOL, 1); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTCLR, 1); | |
| irq_set_handler_locked(data, handle_level_irq); | |
| break; | |
| case IRQ_TYPE_LEVEL_LOW: | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTBOTH, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTMODE, 1); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTPOL, 0); | |
| sprd_eic_update(chip, offset, SPRD_EIC_SYNC_INTCLR, 1); | |
| irq_set_handler_locked(data, handle_level_irq); | |
| break; | |
| default: | |
| return -ENOTSUPP; | |
| } | |
| break; | |
| default: | |
| dev_err(chip->parent, "Unsupported EIC type.\n"); | |
| return -ENOTSUPP; | |
| } | |
| return 0; | |
| } | |
| static void sprd_eic_toggle_trigger(struct gpio_chip *chip, unsigned int irq, | |
| unsigned int offset) | |
| { | |
| struct sprd_eic *sprd_eic = gpiochip_get_data(chip); | |
| struct irq_data *data = irq_get_irq_data(irq); | |
| u32 trigger = irqd_get_trigger_type(data); | |
| int state, post_state; | |
| /* | |
| * The debounce EIC and latch EIC can only support level trigger, so we | |
| * can toggle the level trigger to emulate the edge trigger. | |
| */ | |
| if ((sprd_eic->type != SPRD_EIC_DEBOUNCE && | |
| sprd_eic->type != SPRD_EIC_LATCH) || | |
| !(trigger & IRQ_TYPE_EDGE_BOTH)) | |
| return; | |
| sprd_eic_irq_mask(data); | |
| state = sprd_eic_get(chip, offset); | |
| retry: | |
| switch (sprd_eic->type) { | |
| case SPRD_EIC_DEBOUNCE: | |
| if (state) | |
| sprd_eic_update(chip, offset, SPRD_EIC_DBNC_IEV, 0); | |
| else | |
| sprd_eic_update(chip, offset, SPRD_EIC_DBNC_IEV, 1); | |
| break; | |
| case SPRD_EIC_LATCH: | |
| if (state) | |
| sprd_eic_update(chip, offset, SPRD_EIC_LATCH_INTPOL, 0); | |
| else | |
| sprd_eic_update(chip, offset, SPRD_EIC_LATCH_INTPOL, 1); | |
| break; | |
| default: | |
| sprd_eic_irq_unmask(data); | |
| return; | |
| } | |
| post_state = sprd_eic_get(chip, offset); | |
| if (state != post_state) { | |
| dev_warn(chip->parent, "EIC level was changed.\n"); | |
| state = post_state; | |
| goto retry; | |
| } | |
| sprd_eic_irq_unmask(data); | |
| } | |
| static void sprd_eic_handle_one_type(struct gpio_chip *chip) | |
| { | |
| struct sprd_eic *sprd_eic = gpiochip_get_data(chip); | |
| u32 bank, n, girq; | |
| for (bank = 0; bank * SPRD_EIC_PER_BANK_NR < chip->ngpio; bank++) { | |
| void __iomem *base = sprd_eic_offset_base(sprd_eic, bank); | |
| unsigned long reg; | |
| switch (sprd_eic->type) { | |
| case SPRD_EIC_DEBOUNCE: | |
| reg = readl_relaxed(base + SPRD_EIC_DBNC_MIS) & | |
| SPRD_EIC_DATA_MASK; | |
| break; | |
| case SPRD_EIC_LATCH: | |
| reg = readl_relaxed(base + SPRD_EIC_LATCH_INTMSK) & | |
| SPRD_EIC_DATA_MASK; | |
| break; | |
| case SPRD_EIC_ASYNC: | |
| reg = readl_relaxed(base + SPRD_EIC_ASYNC_INTMSK) & | |
| SPRD_EIC_DATA_MASK; | |
| break; | |
| case SPRD_EIC_SYNC: | |
| reg = readl_relaxed(base + SPRD_EIC_SYNC_INTMSK) & | |
| SPRD_EIC_DATA_MASK; | |
| break; | |
| default: | |
| dev_err(chip->parent, "Unsupported EIC type.\n"); | |
| return; | |
| } | |
| for_each_set_bit(n, ®, SPRD_EIC_PER_BANK_NR) { | |
| u32 offset = bank * SPRD_EIC_PER_BANK_NR + n; | |
| girq = irq_find_mapping(chip->irq.domain, offset); | |
| generic_handle_irq(girq); | |
| sprd_eic_toggle_trigger(chip, girq, offset); | |
| } | |
| } | |
| } | |
| static void sprd_eic_irq_handler(struct irq_desc *desc) | |
| { | |
| struct irq_chip *ic = irq_desc_get_chip(desc); | |
| chained_irq_enter(ic, desc); | |
| /* | |
| * Since the digital-chip EIC 4 sub-modules (debounce, latch, async | |
| * and sync) share one same interrupt line, we should notify all of | |
| * them to let them check if there are EIC interrupts were triggered. | |
| */ | |
| atomic_notifier_call_chain(&sprd_eic_irq_notifier, 0, NULL); | |
| chained_irq_exit(ic, desc); | |
| } | |
| static int sprd_eic_irq_notify(struct notifier_block *nb, unsigned long action, | |
| void *data) | |
| { | |
| struct sprd_eic *sprd_eic = to_sprd_eic(nb); | |
| sprd_eic_handle_one_type(&sprd_eic->chip); | |
| return NOTIFY_OK; | |
| } | |
| static const struct irq_chip sprd_eic_irq = { | |
| .name = "sprd-eic", | |
| .irq_ack = sprd_eic_irq_ack, | |
| .irq_mask = sprd_eic_irq_mask, | |
| .irq_unmask = sprd_eic_irq_unmask, | |
| .irq_set_type = sprd_eic_irq_set_type, | |
| .flags = IRQCHIP_SKIP_SET_WAKE | IRQCHIP_IMMUTABLE, | |
| GPIOCHIP_IRQ_RESOURCE_HELPERS, | |
| }; | |
| static void sprd_eic_unregister_notifier(void *data) | |
| { | |
| struct notifier_block *nb = data; | |
| atomic_notifier_chain_unregister(&sprd_eic_irq_notifier, nb); | |
| } | |
| static int sprd_eic_probe(struct platform_device *pdev) | |
| { | |
| const struct sprd_eic_variant_data *pdata; | |
| struct device *dev = &pdev->dev; | |
| struct gpio_irq_chip *irq; | |
| struct sprd_eic *sprd_eic; | |
| struct resource *res; | |
| u16 num_banks = 0; | |
| int ret, i; | |
| pdata = device_get_match_data(dev); | |
| if (!pdata) { | |
| dev_err(dev, "No matching driver data found.\n"); | |
| return -EINVAL; | |
| } | |
| sprd_eic = devm_kzalloc(dev, sizeof(*sprd_eic), GFP_KERNEL); | |
| if (!sprd_eic) | |
| return -ENOMEM; | |
| raw_spin_lock_init(&sprd_eic->lock); | |
| sprd_eic->type = pdata->type; | |
| sprd_eic->irq = platform_get_irq(pdev, 0); | |
| if (sprd_eic->irq < 0) | |
| return sprd_eic->irq; | |
| for (i = 0; i < SPRD_EIC_MAX_BANK; i++) { | |
| /* | |
| * We can have maximum 3 banks EICs, and each EIC has | |
| * its own base address. But some platform maybe only | |
| * have one bank EIC, thus base[1] and base[2] can be | |
| * optional. | |
| */ | |
| res = platform_get_resource(pdev, IORESOURCE_MEM, i); | |
| if (!res) | |
| break; | |
| sprd_eic->base[i] = devm_ioremap_resource(dev, res); | |
| if (IS_ERR(sprd_eic->base[i])) | |
| return PTR_ERR(sprd_eic->base[i]); | |
| num_banks++; | |
| } | |
| sprd_eic->chip.label = sprd_eic_label_name[sprd_eic->type]; | |
| sprd_eic->chip.ngpio = num_banks * SPRD_EIC_PER_BANK_NR; | |
| sprd_eic->chip.base = -1; | |
| sprd_eic->chip.parent = dev; | |
| sprd_eic->chip.direction_input = sprd_eic_direction_input; | |
| switch (sprd_eic->type) { | |
| case SPRD_EIC_DEBOUNCE: | |
| sprd_eic->chip.request = sprd_eic_request; | |
| sprd_eic->chip.free = sprd_eic_free; | |
| sprd_eic->chip.set_config = sprd_eic_set_config; | |
| sprd_eic->chip.set = sprd_eic_set; | |
| fallthrough; | |
| case SPRD_EIC_ASYNC: | |
| case SPRD_EIC_SYNC: | |
| sprd_eic->chip.get = sprd_eic_get; | |
| break; | |
| case SPRD_EIC_LATCH: | |
| default: | |
| break; | |
| } | |
| irq = &sprd_eic->chip.irq; | |
| gpio_irq_chip_set_chip(irq, &sprd_eic_irq); | |
| irq->handler = handle_bad_irq; | |
| irq->default_type = IRQ_TYPE_NONE; | |
| irq->parent_handler = sprd_eic_irq_handler; | |
| irq->parent_handler_data = sprd_eic; | |
| irq->num_parents = 1; | |
| irq->parents = &sprd_eic->irq; | |
| ret = devm_gpiochip_add_data(dev, &sprd_eic->chip, sprd_eic); | |
| if (ret < 0) { | |
| dev_err(dev, "Could not register gpiochip %d.\n", ret); | |
| return ret; | |
| } | |
| sprd_eic->irq_nb.notifier_call = sprd_eic_irq_notify; | |
| ret = atomic_notifier_chain_register(&sprd_eic_irq_notifier, | |
| &sprd_eic->irq_nb); | |
| if (ret) | |
| return dev_err_probe(dev, ret, | |
| "Failed to register with the interrupt notifier"); | |
| return devm_add_action_or_reset(dev, sprd_eic_unregister_notifier, | |
| &sprd_eic->irq_nb); | |
| } | |
| static const struct of_device_id sprd_eic_of_match[] = { | |
| { | |
| .compatible = "sprd,sc9860-eic-debounce", | |
| .data = &sc9860_eic_dbnc_data, | |
| }, | |
| { | |
| .compatible = "sprd,sc9860-eic-latch", | |
| .data = &sc9860_eic_latch_data, | |
| }, | |
| { | |
| .compatible = "sprd,sc9860-eic-async", | |
| .data = &sc9860_eic_async_data, | |
| }, | |
| { | |
| .compatible = "sprd,sc9860-eic-sync", | |
| .data = &sc9860_eic_sync_data, | |
| }, | |
| { | |
| /* end of list */ | |
| } | |
| }; | |
| MODULE_DEVICE_TABLE(of, sprd_eic_of_match); | |
| static struct platform_driver sprd_eic_driver = { | |
| .probe = sprd_eic_probe, | |
| .driver = { | |
| .name = "sprd-eic", | |
| .of_match_table = sprd_eic_of_match, | |
| }, | |
| }; | |
| module_platform_driver(sprd_eic_driver); | |
| MODULE_DESCRIPTION("Spreadtrum EIC driver"); | |
| MODULE_LICENSE("GPL v2"); |