AuxXxilium/linux_dsm_epyc7002
1
0
Fork 0
mirror of https://github.com/AuxXxilium/linux_dsm_epyc7002.git synced 2024-11-24 20:40:52 +07:00
Code Issues Actions Packages Projects Releases Wiki Activity

mfd: cpcap: Implement IRQ sense helper

Browse Source 
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>
This commit is contained in:
Sebastian Reichel 2017-03-29 14:18:20 +02:00 committed by Lee Jones
parent c1ae3cfa0e
commit ab781ec0e5
2 changed files with 30 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

28
drivers/mfd/motorola-cpcap.c
View File

@ -23,6 +23,8 @@
#define CPCAP_NR_IRQ_REG_BANKS 6 #define CPCAP_NR_IRQ_REG_BANKS 6
#define CPCAP_NR_IRQ_CHIPS 3 #define CPCAP_NR_IRQ_CHIPS 3
#define CPCAP_REGISTER_SIZE 4
#define CPCAP_REGISTER_BITS 16
struct cpcap_ddata { struct cpcap_ddata {
struct spi_device *spi; struct spi_device *spi;
@ -32,6 +34,32 @@ struct cpcap_ddata {
struct regmap *regmap; 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) static int cpcap_check_revision(struct cpcap_ddata *cpcap)
{ {
u16 vendor, rev; u16 vendor, rev;

2
include/linux/mfd/motorola-cpcap.h
View File

@ -290,3 +290,5 @@ static inline int cpcap_get_vendor(struct device *dev,
return 0; return 0;
} }
extern int cpcap_sense_virq(struct regmap *regmap, int virq);