regmap: irq: Allow to acknowledge masked interrupts during initialization

In case the hardware interrupt mask register does not prevent the chip level
irq from being asserted by the corresponding interrupt status bit, already
set interrupt bits should to be cleared once after masking them during
initialization. Add a flag to let drivers enable this behavior.

Signed-off-by: Philipp Zabel <p.zabel@pengutronix.de>
Signed-off-by: Mark Brown <broonie@linaro.org>

1 files changed, 25 insertions, 0 deletions

diff --git a/drivers/base/regmap/regmap-irq.c b/drivers/base/regmap/regmap-irq.c
index 1643e889bafc..d10456ffd811 100644
--- a/drivers/base/regmap/regmap-irq.c
+++ b/drivers/base/regmap/regmap-irq.c
@@ -418,6 +418,31 @@ int regmap_add_irq_chip(struct regmap *map, int irq, int irq_flags,
                                 reg, ret);
                         goto err_alloc;
                 }
+
+                if (!chip->init_ack_masked)
+                        continue;
+
+                /* Ack masked but set interrupts */
+                reg = chip->status_base +
+                        (i * map->reg_stride * d->irq_reg_stride);
+                ret = regmap_read(map, reg, &d->status_buf[i]);
+                if (ret != 0) {
+                        dev_err(map->dev, "Failed to read IRQ status: %d\n",
+                                ret);
+                        goto err_alloc;
+                }
+
+                if (d->status_buf[i] && chip->ack_base) {
+                        reg = chip->ack_base +
+                                (i * map->reg_stride * d->irq_reg_stride);
+                        ret = regmap_write(map, reg,
+                                        d->status_buf[i] & d->mask_buf[i]);
+                        if (ret != 0) {
+                                dev_err(map->dev, "Failed to ack 0x%x: %d\n",
+                                        reg, ret);
+                                goto err_alloc;
+                        }
+                }
         }
 
         /* Wake is disabled by default */