| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152 |
- From 086480cc43b9d967647b237a84623b27b8850a64 Mon Sep 17 00:00:00 2001
- From: Phil Elwell <[email protected]>
- Date: Wed, 3 Apr 2024 23:16:47 +0100
- Subject: [PATCH 4/5] pinctrl: rp1: Support interrupt CPU affinity
- See: https://github.com/raspberrypi/linux/issues/6077
- Signed-off-by: Phil Elwell <[email protected]>
- ---
- drivers/pinctrl/pinctrl-rp1.c | 24 ++++++++++++++++++++++++
- 1 file changed, 24 insertions(+)
- --- a/drivers/pinctrl/pinctrl-rp1.c
- +++ b/drivers/pinctrl/pinctrl-rp1.c
- @@ -894,6 +894,29 @@ static void rp1_gpio_irq_ack(struct irq_
- writel(RP1_GPIO_CTRL_IRQRESET, pin->gpio + RP1_SET_OFFSET + RP1_GPIO_CTRL);
- }
-
- +static int rp1_gpio_irq_set_affinity(struct irq_data *data, const struct cpumask *dest, bool force)
- +{
- + struct gpio_chip *chip = irq_data_get_irq_chip_data(data);
- + struct rp1_pinctrl *pc = gpiochip_get_data(chip);
- + const struct rp1_iobank_desc *bank;
- + struct irq_data *parent_data = NULL;
- + int i;
- +
- + for (i = 0; i < 3; i++) {
- + bank = &rp1_iobanks[i];
- + if (data->hwirq >= bank->min_gpio &&
- + data->hwirq < bank->min_gpio + bank->num_gpios) {
- + parent_data = irq_get_irq_data(pc->irq[i]);
- + break;
- + }
- + }
- +
- + if (parent_data && parent_data->chip->irq_set_affinity)
- + return parent_data->chip->irq_set_affinity(parent_data, dest, force);
- +
- + return -EINVAL;
- +}
- +
- static struct irq_chip rp1_gpio_irq_chip = {
- .name = MODULE_NAME,
- .irq_enable = rp1_gpio_irq_enable,
- @@ -902,6 +925,7 @@ static struct irq_chip rp1_gpio_irq_chip
- .irq_ack = rp1_gpio_irq_ack,
- .irq_mask = rp1_gpio_irq_disable,
- .irq_unmask = rp1_gpio_irq_enable,
- + .irq_set_affinity = rp1_gpio_irq_set_affinity,
- .flags = IRQCHIP_IMMUTABLE,
- };
-
|
