mfd: cpcap: Implement IRQ sense helper

CPCAP can sense if IRQ is currently set or not. This
functionality is required for a few subdevices, such
as the power button and usb phy modules.

Signed-off-by: Sebastian Reichel <sre@kernel.org>
Acked-by: Tony Lindgren <tony@atomide.com>
Signed-off-by: Lee Jones <lee.jones@linaro.org>

diff --git a/drivers/mfd/motorola-cpcap.c b/drivers/mfd/motorola-cpcap.c
index 6aeada7d7ce58627130a926c2649f0cae95ad260..a9097efcefa589ceae1748059967d6dfc5e64843 100644 (file)
--- a/drivers/mfd/motorola-cpcap.c
+++ b/drivers/mfd/motorola-cpcap.c
@@ -23,6 +23,8 @@
 
 #define CPCAP_NR_IRQ_REG_BANKS 6
 #define CPCAP_NR_IRQ_CHIPS     3
+#define CPCAP_REGISTER_SIZE    4
+#define CPCAP_REGISTER_BITS    16
 
 struct cpcap_ddata {
        struct spi_device *spi;
@@ -32,6 +34,32 @@ struct cpcap_ddata {
        struct regmap *regmap;
 };
 
+static int cpcap_sense_irq(struct regmap *regmap, int irq)
+{
+       int regnum = irq / CPCAP_REGISTER_BITS;
+       int mask = BIT(irq % CPCAP_REGISTER_BITS);
+       int reg = CPCAP_REG_INTS1 + (regnum * CPCAP_REGISTER_SIZE);
+       int err, val;
+
+       if (reg < CPCAP_REG_INTS1 || reg > CPCAP_REG_INTS4)
+               return -EINVAL;
+
+       err = regmap_read(regmap, reg, &val);
+       if (err)
+               return err;
+
+       return !!(val & mask);
+}
+
+int cpcap_sense_virq(struct regmap *regmap, int virq)
+{
+       struct regmap_irq_chip_data *d = irq_get_chip_data(virq);
+       int irq_base = regmap_irq_chip_get_base(d);
+
+       return cpcap_sense_irq(regmap, virq - irq_base);
+}
+EXPORT_SYMBOL_GPL(cpcap_sense_virq);
+
 static int cpcap_check_revision(struct cpcap_ddata *cpcap)
 {
        u16 vendor, rev;

diff --git a/include/linux/mfd/motorola-cpcap.h b/include/linux/mfd/motorola-cpcap.h
index b4031c2b2214fc2f5417f14756e14f6cd5ff63d2..793aa695faa000e12e66a98956f57d40abdef237 100644 (file)
--- a/include/linux/mfd/motorola-cpcap.h
+++ b/include/linux/mfd/motorola-cpcap.h
@@ -290,3 +290,5 @@ static inline int cpcap_get_vendor(struct device *dev,
 
        return 0;
 }
+
+extern int cpcap_sense_virq(struct regmap *regmap, int virq);