pinctrl: stm32: add syscfg mask parameter
This patch adds mask parameter to define IRQ mux field. This field could vary depend of IRQ mux selection register. To avoid backward compatibility, the drivers set the legacy value by default. Signed-off-by: Ludovic Barre <ludovic.barre@st.com> Acked-by: Alexandre TORGUE <alexandre.torgue@st.com> Signed-off-by: Linus Walleij <linus.walleij@linaro.org>
This commit is contained in:
parent
de1d08b229
commit
2e25a9cbdf
@ -46,6 +46,8 @@
|
|||||||
#define STM32_GPIO_PINS_PER_BANK 16
|
#define STM32_GPIO_PINS_PER_BANK 16
|
||||||
#define STM32_GPIO_IRQ_LINE 16
|
#define STM32_GPIO_IRQ_LINE 16
|
||||||
|
|
||||||
|
#define SYSCFG_IRQMUX_MASK GENMASK(3, 0)
|
||||||
|
|
||||||
#define gpio_range_to_bank(chip) \
|
#define gpio_range_to_bank(chip) \
|
||||||
container_of(chip, struct stm32_gpio_bank, range)
|
container_of(chip, struct stm32_gpio_bank, range)
|
||||||
|
|
||||||
@ -1054,6 +1056,7 @@ static int stm32_pctrl_dt_setup_irq(struct platform_device *pdev,
|
|||||||
struct device *dev = &pdev->dev;
|
struct device *dev = &pdev->dev;
|
||||||
struct regmap *rm;
|
struct regmap *rm;
|
||||||
int offset, ret, i;
|
int offset, ret, i;
|
||||||
|
int mask, mask_width;
|
||||||
|
|
||||||
parent = of_irq_find_parent(np);
|
parent = of_irq_find_parent(np);
|
||||||
if (!parent)
|
if (!parent)
|
||||||
@ -1073,12 +1076,21 @@ static int stm32_pctrl_dt_setup_irq(struct platform_device *pdev,
|
|||||||
if (ret)
|
if (ret)
|
||||||
return ret;
|
return ret;
|
||||||
|
|
||||||
|
ret = of_property_read_u32_index(np, "st,syscfg", 2, &mask);
|
||||||
|
if (ret)
|
||||||
|
mask = SYSCFG_IRQMUX_MASK;
|
||||||
|
|
||||||
|
mask_width = fls(mask);
|
||||||
|
|
||||||
for (i = 0; i < STM32_GPIO_PINS_PER_BANK; i++) {
|
for (i = 0; i < STM32_GPIO_PINS_PER_BANK; i++) {
|
||||||
struct reg_field mux;
|
struct reg_field mux;
|
||||||
|
|
||||||
mux.reg = offset + (i / 4) * 4;
|
mux.reg = offset + (i / 4) * 4;
|
||||||
mux.lsb = (i % 4) * 4;
|
mux.lsb = (i % 4) * mask_width;
|
||||||
mux.msb = mux.lsb + 3;
|
mux.msb = mux.lsb + mask_width - 1;
|
||||||
|
|
||||||
|
dev_dbg(dev, "irqmux%d: reg:%#x, lsb:%d, msb:%d\n",
|
||||||
|
i, mux.reg, mux.lsb, mux.msb);
|
||||||
|
|
||||||
pctl->irqmux[i] = devm_regmap_field_alloc(dev, rm, mux);
|
pctl->irqmux[i] = devm_regmap_field_alloc(dev, rm, mux);
|
||||||
if (IS_ERR(pctl->irqmux[i]))
|
if (IS_ERR(pctl->irqmux[i]))
|
||||||
|
Loading…
Reference in New Issue
Block a user