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>

1 files changed, 38 insertions, 27 deletions

diff --git a/drivers/mfd/88pm860x-core.c b/drivers/mfd/88pm860x-core.c
index 72bf290bd020..5b56fe8250b4 100644
--- a/drivers/mfd/88pm860x-core.c
+++ b/drivers/mfd/88pm860x-core.c
@@ -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) {