mirror of
https://github.com/torvalds/linux.git
synced 2024-11-29 23:51:37 +00:00
mfd: 88pm860x: Use irqdomain
Use irqdomain and allocating interrupts. It's necessary for supporting DT mode. Signed-off-by: Haojian Zhuang <haojian.zhuang@gmail.com> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
This commit is contained in:
parent
8284328cd9
commit
837c8293ba
@ -15,6 +15,7 @@
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/irqdomain.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/regmap.h>
|
||||
#include <linux/slab.h>
|
||||
@ -520,15 +521,12 @@ static void pm860x_irq_sync_unlock(struct irq_data *data)
|
||||
|
||||
static void pm860x_irq_enable(struct irq_data *data)
|
||||
{
|
||||
struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
|
||||
pm860x_irqs[data->irq - chip->irq_base].enable
|
||||
= pm860x_irqs[data->irq - chip->irq_base].offs;
|
||||
pm860x_irqs[data->hwirq].enable = pm860x_irqs[data->hwirq].offs;
|
||||
}
|
||||
|
||||
static void pm860x_irq_disable(struct irq_data *data)
|
||||
{
|
||||
struct pm860x_chip *chip = irq_data_get_irq_chip_data(data);
|
||||
pm860x_irqs[data->irq - chip->irq_base].enable = 0;
|
||||
pm860x_irqs[data->hwirq].enable = 0;
|
||||
}
|
||||
|
||||
static struct irq_chip pm860x_irq_chip = {
|
||||
@ -539,6 +537,25 @@ static struct irq_chip pm860x_irq_chip = {
|
||||
.irq_disable = pm860x_irq_disable,
|
||||
};
|
||||
|
||||
static int pm860x_irq_domain_map(struct irq_domain *d, unsigned int virq,
|
||||
irq_hw_number_t hw)
|
||||
{
|
||||
irq_set_chip_data(virq, d->host_data);
|
||||
irq_set_chip_and_handler(virq, &pm860x_irq_chip, handle_edge_irq);
|
||||
irq_set_nested_thread(virq, 1);
|
||||
#ifdef CONFIG_ARM
|
||||
set_irq_flags(virq, IRQF_VALID);
|
||||
#else
|
||||
irq_set_noprobe(virq);
|
||||
#endif
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct irq_domain_ops pm860x_irq_domain_ops = {
|
||||
.map = pm860x_irq_domain_map,
|
||||
.xlate = irq_domain_xlate_onetwocell,
|
||||
};
|
||||
|
||||
static int __devinit device_gpadc_init(struct pm860x_chip *chip,
|
||||
struct pm860x_platform_data *pdata)
|
||||
{
|
||||
@ -593,13 +610,9 @@ static int __devinit device_irq_init(struct pm860x_chip *chip,
|
||||
: chip->companion;
|
||||
unsigned char status_buf[INT_STATUS_NUM];
|
||||
unsigned long flags = IRQF_TRIGGER_FALLING | IRQF_ONESHOT;
|
||||
int i, data, mask, ret = -EINVAL;
|
||||
int __irq;
|
||||
|
||||
if (!pdata || !pdata->irq_base) {
|
||||
dev_warn(chip->dev, "No interrupt support on IRQ base\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
int data, mask, ret = -EINVAL;
|
||||
int nr_irqs, irq_base = -1;
|
||||
struct device_node *node = i2c->dev.of_node;
|
||||
|
||||
mask = PM8607_B0_MISC1_INV_INT | PM8607_B0_MISC1_INT_CLEAR
|
||||
| PM8607_B0_MISC1_INT_MASK;
|
||||
@ -639,25 +652,23 @@ static int __devinit device_irq_init(struct pm860x_chip *chip,
|
||||
goto out;
|
||||
|
||||
mutex_init(&chip->irq_lock);
|
||||
chip->irq_base = pdata->irq_base;
|
||||
|
||||
if (pdata && pdata->irq_base)
|
||||
irq_base = pdata->irq_base;
|
||||
nr_irqs = ARRAY_SIZE(pm860x_irqs);
|
||||
chip->irq_base = irq_alloc_descs(irq_base, 0, nr_irqs, 0);
|
||||
if (chip->irq_base < 0) {
|
||||
dev_err(&i2c->dev, "Failed to allocate interrupts, ret:%d\n",
|
||||
chip->irq_base);
|
||||
ret = -EBUSY;
|
||||
goto out;
|
||||
}
|
||||
irq_domain_add_legacy(node, nr_irqs, chip->irq_base, 0,
|
||||
&pm860x_irq_domain_ops, chip);
|
||||
chip->core_irq = i2c->irq;
|
||||
if (!chip->core_irq)
|
||||
goto out;
|
||||
|
||||
/* register IRQ by genirq */
|
||||
for (i = 0; i < ARRAY_SIZE(pm860x_irqs); i++) {
|
||||
__irq = i + chip->irq_base;
|
||||
irq_set_chip_data(__irq, chip);
|
||||
irq_set_chip_and_handler(__irq, &pm860x_irq_chip,
|
||||
handle_edge_irq);
|
||||
irq_set_nested_thread(__irq, 1);
|
||||
#ifdef CONFIG_ARM
|
||||
set_irq_flags(__irq, IRQF_VALID);
|
||||
#else
|
||||
irq_set_noprobe(__irq);
|
||||
#endif
|
||||
}
|
||||
|
||||
ret = request_threaded_irq(chip->core_irq, NULL, pm860x_irq, flags | IRQF_ONESHOT,
|
||||
"88pm860x", chip);
|
||||
if (ret) {
|
||||
|
Loading…
Reference in New Issue
Block a user