When acking irqs we need to take into account the ack-invert case. Without
this chips that require 0's to ACK interrupts will never clear the interrupt.

I am working on an mfd driver that will use ack-invert and discovered
this issue. The only user of ack_invert currently appears to be the
motorola-cpcap driver. I'm not clear why that driver doesn't appear affected
so I'm cc'ing those involved with that driver for review and testing.

Cc: Benjamin Gaignard <[email protected]>
Cc: Lee Jones <[email protected]>
Cc: Tony Lindgren <[email protected]>
Signed-off-by: Tim Harvey <[email protected]>
---
 drivers/base/regmap/regmap-irq.c | 17 +++++++++++++----
 1 file changed, 13 insertions(+), 4 deletions(-)

diff --git a/drivers/base/regmap/regmap-irq.c b/drivers/base/regmap/regmap-irq.c
index 429ca8e..abfed41 100644
--- a/drivers/base/regmap/regmap-irq.c
+++ b/drivers/base/regmap/regmap-irq.c
@@ -355,16 +355,25 @@ static irqreturn_t regmap_irq_thread(int irq, void *d)
         * doing a write per register.
         */
        for (i = 0; i < data->chip->num_regs; i++) {
-               data->status_buf[i] &= ~data->mask_buf[i];
-
-               if (data->status_buf[i] && (chip->ack_base || chip->use_ack)) {
+               if ( (data->status_buf[i] & ~data->mask_buf[i]) &&
+                    (chip->ack_base || chip->use_ack) ) {
                        reg = chip->ack_base +
                                (i * map->reg_stride * data->irq_reg_stride);
-                       ret = regmap_write(map, reg, data->status_buf[i]);
+                       /* some chips ack by write 0 */
+                       if (chip->ack_invert)
+                               ret = regmap_write(map, reg,
+                                                  ~data->status_buf[i] &
+                                                  ~data->mask_buf[i]);
+
+                       else
+                               ret = regmap_write(map, reg,
+                                                  data->status_buf[i] &
+                                                  ~data->mask_buf[i]);
                        if (ret != 0)
                                dev_err(map->dev, "Failed to ack 0x%x: %d\n",
                                        reg, ret);
                }
+               data->status_buf[i] &= ~data->mask_buf[i];
        }
 
        for (i = 0; i < chip->num_irqs; i++) {
-- 
2.7.4

Reply via email to