irqchip/stm32-exti: Map direct event to irq parent
EXTI lines are mainly used to wake-up system from CStop low power mode. Currently, if a device wants to use a EXTI (direct) line as wakeup line, it has to declare 2 interrupts: - one for EXTI used to wake-up system (with dedicated_wake_irq api). - one for GIC used to get the wake up reason inside the concerned IP. This split is not really needed as each EXTI line is actually "linked " to a GIC. So to avoid this useless double interrupt management in each wake-up driver, this patch lets the STM32 EXTI driver abstract it by mapping each EXTI line to his corresponding GIC. Signed-off-by: Alexandre Torgue <alexandre.torgue@st.com> Signed-off-by: Marc Zyngier <maz@kernel.org> Link: https://lore.kernel.org/r/20200717140717.29606-1-alexandre.torgue@st.com
This commit is contained in:
Родитель
920ecb8c35
Коммит
9d6a5fe175
|
@ -41,6 +41,7 @@ struct stm32_exti_bank {
|
||||||
struct stm32_desc_irq {
|
struct stm32_desc_irq {
|
||||||
u32 exti;
|
u32 exti;
|
||||||
u32 irq_parent;
|
u32 irq_parent;
|
||||||
|
struct irq_chip *chip;
|
||||||
};
|
};
|
||||||
|
|
||||||
struct stm32_exti_drv_data {
|
struct stm32_exti_drv_data {
|
||||||
|
@ -165,27 +166,41 @@ static const struct stm32_exti_bank *stm32mp1_exti_banks[] = {
|
||||||
&stm32mp1_exti_b3,
|
&stm32mp1_exti_b3,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static struct irq_chip stm32_exti_h_chip;
|
||||||
|
static struct irq_chip stm32_exti_h_chip_direct;
|
||||||
|
|
||||||
static const struct stm32_desc_irq stm32mp1_desc_irq[] = {
|
static const struct stm32_desc_irq stm32mp1_desc_irq[] = {
|
||||||
{ .exti = 0, .irq_parent = 6 },
|
{ .exti = 0, .irq_parent = 6, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 1, .irq_parent = 7 },
|
{ .exti = 1, .irq_parent = 7, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 2, .irq_parent = 8 },
|
{ .exti = 2, .irq_parent = 8, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 3, .irq_parent = 9 },
|
{ .exti = 3, .irq_parent = 9, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 4, .irq_parent = 10 },
|
{ .exti = 4, .irq_parent = 10, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 5, .irq_parent = 23 },
|
{ .exti = 5, .irq_parent = 23, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 6, .irq_parent = 64 },
|
{ .exti = 6, .irq_parent = 64, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 7, .irq_parent = 65 },
|
{ .exti = 7, .irq_parent = 65, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 8, .irq_parent = 66 },
|
{ .exti = 8, .irq_parent = 66, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 9, .irq_parent = 67 },
|
{ .exti = 9, .irq_parent = 67, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 10, .irq_parent = 40 },
|
{ .exti = 10, .irq_parent = 40, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 11, .irq_parent = 42 },
|
{ .exti = 11, .irq_parent = 42, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 12, .irq_parent = 76 },
|
{ .exti = 12, .irq_parent = 76, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 13, .irq_parent = 77 },
|
{ .exti = 13, .irq_parent = 77, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 14, .irq_parent = 121 },
|
{ .exti = 14, .irq_parent = 121, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 15, .irq_parent = 127 },
|
{ .exti = 15, .irq_parent = 127, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 16, .irq_parent = 1 },
|
{ .exti = 16, .irq_parent = 1, .chip = &stm32_exti_h_chip },
|
||||||
{ .exti = 65, .irq_parent = 144 },
|
{ .exti = 19, .irq_parent = 3, .chip = &stm32_exti_h_chip_direct },
|
||||||
{ .exti = 68, .irq_parent = 143 },
|
{ .exti = 21, .irq_parent = 31, .chip = &stm32_exti_h_chip_direct },
|
||||||
{ .exti = 73, .irq_parent = 129 },
|
{ .exti = 22, .irq_parent = 33, .chip = &stm32_exti_h_chip_direct },
|
||||||
|
{ .exti = 23, .irq_parent = 72, .chip = &stm32_exti_h_chip_direct },
|
||||||
|
{ .exti = 24, .irq_parent = 95, .chip = &stm32_exti_h_chip_direct },
|
||||||
|
{ .exti = 25, .irq_parent = 107, .chip = &stm32_exti_h_chip_direct },
|
||||||
|
{ .exti = 30, .irq_parent = 52, .chip = &stm32_exti_h_chip_direct },
|
||||||
|
{ .exti = 47, .irq_parent = 93, .chip = &stm32_exti_h_chip_direct },
|
||||||
|
{ .exti = 54, .irq_parent = 135, .chip = &stm32_exti_h_chip_direct },
|
||||||
|
{ .exti = 61, .irq_parent = 100, .chip = &stm32_exti_h_chip_direct },
|
||||||
|
{ .exti = 65, .irq_parent = 144, .chip = &stm32_exti_h_chip },
|
||||||
|
{ .exti = 68, .irq_parent = 143, .chip = &stm32_exti_h_chip },
|
||||||
|
{ .exti = 70, .irq_parent = 62, .chip = &stm32_exti_h_chip_direct },
|
||||||
|
{ .exti = 73, .irq_parent = 129, .chip = &stm32_exti_h_chip },
|
||||||
};
|
};
|
||||||
|
|
||||||
static const struct stm32_exti_drv_data stm32mp1_drv_data = {
|
static const struct stm32_exti_drv_data stm32mp1_drv_data = {
|
||||||
|
@ -195,22 +210,23 @@ static const struct stm32_exti_drv_data stm32mp1_drv_data = {
|
||||||
.irq_nr = ARRAY_SIZE(stm32mp1_desc_irq),
|
.irq_nr = ARRAY_SIZE(stm32mp1_desc_irq),
|
||||||
};
|
};
|
||||||
|
|
||||||
static int stm32_exti_to_irq(const struct stm32_exti_drv_data *drv_data,
|
static const struct
|
||||||
irq_hw_number_t hwirq)
|
stm32_desc_irq *stm32_exti_get_desc(const struct stm32_exti_drv_data *drv_data,
|
||||||
|
irq_hw_number_t hwirq)
|
||||||
{
|
{
|
||||||
const struct stm32_desc_irq *desc_irq;
|
const struct stm32_desc_irq *desc = NULL;
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
if (!drv_data->desc_irqs)
|
if (!drv_data->desc_irqs)
|
||||||
return -EINVAL;
|
return NULL;
|
||||||
|
|
||||||
for (i = 0; i < drv_data->irq_nr; i++) {
|
for (i = 0; i < drv_data->irq_nr; i++) {
|
||||||
desc_irq = &drv_data->desc_irqs[i];
|
desc = &drv_data->desc_irqs[i];
|
||||||
if (desc_irq->exti == hwirq)
|
if (desc->exti == hwirq)
|
||||||
return desc_irq->irq_parent;
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
return -EINVAL;
|
return desc;
|
||||||
}
|
}
|
||||||
|
|
||||||
static unsigned long stm32_exti_pending(struct irq_chip_generic *gc)
|
static unsigned long stm32_exti_pending(struct irq_chip_generic *gc)
|
||||||
|
@ -603,30 +619,47 @@ static struct irq_chip stm32_exti_h_chip = {
|
||||||
.irq_set_affinity = IS_ENABLED(CONFIG_SMP) ? stm32_exti_h_set_affinity : NULL,
|
.irq_set_affinity = IS_ENABLED(CONFIG_SMP) ? stm32_exti_h_set_affinity : NULL,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static struct irq_chip stm32_exti_h_chip_direct = {
|
||||||
|
.name = "stm32-exti-h-direct",
|
||||||
|
.irq_eoi = irq_chip_eoi_parent,
|
||||||
|
.irq_ack = irq_chip_ack_parent,
|
||||||
|
.irq_mask = irq_chip_mask_parent,
|
||||||
|
.irq_unmask = irq_chip_unmask_parent,
|
||||||
|
.irq_retrigger = irq_chip_retrigger_hierarchy,
|
||||||
|
.irq_set_type = irq_chip_set_type_parent,
|
||||||
|
.irq_set_wake = stm32_exti_h_set_wake,
|
||||||
|
.flags = IRQCHIP_MASK_ON_SUSPEND,
|
||||||
|
.irq_set_affinity = IS_ENABLED(CONFIG_SMP) ? irq_chip_set_affinity_parent : NULL,
|
||||||
|
};
|
||||||
|
|
||||||
static int stm32_exti_h_domain_alloc(struct irq_domain *dm,
|
static int stm32_exti_h_domain_alloc(struct irq_domain *dm,
|
||||||
unsigned int virq,
|
unsigned int virq,
|
||||||
unsigned int nr_irqs, void *data)
|
unsigned int nr_irqs, void *data)
|
||||||
{
|
{
|
||||||
struct stm32_exti_host_data *host_data = dm->host_data;
|
struct stm32_exti_host_data *host_data = dm->host_data;
|
||||||
struct stm32_exti_chip_data *chip_data;
|
struct stm32_exti_chip_data *chip_data;
|
||||||
|
const struct stm32_desc_irq *desc;
|
||||||
struct irq_fwspec *fwspec = data;
|
struct irq_fwspec *fwspec = data;
|
||||||
struct irq_fwspec p_fwspec;
|
struct irq_fwspec p_fwspec;
|
||||||
irq_hw_number_t hwirq;
|
irq_hw_number_t hwirq;
|
||||||
int p_irq, bank;
|
int bank;
|
||||||
|
|
||||||
hwirq = fwspec->param[0];
|
hwirq = fwspec->param[0];
|
||||||
bank = hwirq / IRQS_PER_BANK;
|
bank = hwirq / IRQS_PER_BANK;
|
||||||
chip_data = &host_data->chips_data[bank];
|
chip_data = &host_data->chips_data[bank];
|
||||||
|
|
||||||
irq_domain_set_hwirq_and_chip(dm, virq, hwirq,
|
|
||||||
&stm32_exti_h_chip, chip_data);
|
|
||||||
|
|
||||||
p_irq = stm32_exti_to_irq(host_data->drv_data, hwirq);
|
desc = stm32_exti_get_desc(host_data->drv_data, hwirq);
|
||||||
if (p_irq >= 0) {
|
if (!desc)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
irq_domain_set_hwirq_and_chip(dm, virq, hwirq, desc->chip,
|
||||||
|
chip_data);
|
||||||
|
if (desc->irq_parent) {
|
||||||
p_fwspec.fwnode = dm->parent->fwnode;
|
p_fwspec.fwnode = dm->parent->fwnode;
|
||||||
p_fwspec.param_count = 3;
|
p_fwspec.param_count = 3;
|
||||||
p_fwspec.param[0] = GIC_SPI;
|
p_fwspec.param[0] = GIC_SPI;
|
||||||
p_fwspec.param[1] = p_irq;
|
p_fwspec.param[1] = desc->irq_parent;
|
||||||
p_fwspec.param[2] = IRQ_TYPE_LEVEL_HIGH;
|
p_fwspec.param[2] = IRQ_TYPE_LEVEL_HIGH;
|
||||||
|
|
||||||
return irq_domain_alloc_irqs_parent(dm, virq, 1, &p_fwspec);
|
return irq_domain_alloc_irqs_parent(dm, virq, 1, &p_fwspec);
|
||||||
|
|
Загрузка…
Ссылка в новой задаче