Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit ab781ec0 authored by Sebastian Reichel's avatar Sebastian Reichel Committed by Lee Jones
Browse files

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: default avatarSebastian Reichel <sre@kernel.org>
Acked-by: default avatarTony Lindgren <tony@atomide.com>
Signed-off-by: default avatarLee Jones <lee.jones@linaro.org>
parent c1ae3cfa

drivers/mfd/motorola-cpcap.c

+28 −0
Original line number Diff line number Diff line
@@ -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;

include/linux/mfd/motorola-cpcap.h

+2 −0
Original line number Diff line number Diff line
@@ -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);