1 files changed, 35 insertions, 12 deletions

diff --git a/drivers/mfd/db8500-prcmu.c b/drivers/mfd/db8500-prcmu.c
index 6b67edbdbd01..00b8b0f3dfb6 100644
--- a/drivers/mfd/db8500-prcmu.c
+++ b/drivers/mfd/db8500-prcmu.c
@@ -270,6 +270,8 @@ static struct {
         struct prcmu_fw_version version;
 } fw_info;
 
+static struct irq_domain *db8500_irq_domain;
+
 /*
  * This vector maps irq numbers to the bits in the bit field used in
  * communication with the PRCMU firmware.
@@ -2624,7 +2626,7 @@ static void prcmu_irq_mask(struct irq_data *d)
 
         spin_lock_irqsave(&mb0_transfer.dbb_irqs_lock, flags);
 
-        mb0_transfer.req.dbb_irqs &= ~prcmu_irq_bit[d->irq - IRQ_PRCMU_BASE];
+        mb0_transfer.req.dbb_irqs &= ~prcmu_irq_bit[d->hwirq];
 
         spin_unlock_irqrestore(&mb0_transfer.dbb_irqs_lock, flags);
 
@@ -2638,7 +2640,7 @@ static void prcmu_irq_unmask(struct irq_data *d)
 
         spin_lock_irqsave(&mb0_transfer.dbb_irqs_lock, flags);
 
-        mb0_transfer.req.dbb_irqs |= prcmu_irq_bit[d->irq - IRQ_PRCMU_BASE];
+        mb0_transfer.req.dbb_irqs |= prcmu_irq_bit[d->hwirq];
 
         spin_unlock_irqrestore(&mb0_transfer.dbb_irqs_lock, flags);
 
@@ -2678,9 +2680,37 @@ static char *fw_project_name(u8 project)
         }
 }
 
+static int db8500_irq_map(struct irq_domain *d, unsigned int virq,
+                                irq_hw_number_t hwirq)
+{
+        irq_set_chip_and_handler(virq, &prcmu_irq_chip,
+                                handle_simple_irq);
+        set_irq_flags(virq, IRQF_VALID);
+
+        return 0;
+}
+
+static struct irq_domain_ops db8500_irq_ops = {
+        .map    = db8500_irq_map,
+        .xlate  = irq_domain_xlate_twocell,
+};
+
+static int db8500_irq_init(struct device_node *np)
+{
+        db8500_irq_domain = irq_domain_add_legacy(
+                np, NUM_PRCMU_WAKEUPS, IRQ_PRCMU_BASE,
+                0, &db8500_irq_ops, NULL);
+
+        if (!db8500_irq_domain) {
+                pr_err("Failed to create irqdomain\n");
+                return -ENOSYS;
+        }
+
+        return 0;
+}
+
 void __init db8500_prcmu_early_init(void)
 {
-        unsigned int i;
         if (cpu_is_u8500v2()) {
                 void *tcpm_base = ioremap_nocache(U8500_PRCMU_TCPM_BASE, SZ_4K);
 
@@ -2725,15 +2755,6 @@ void __init db8500_prcmu_early_init(void)
 
         INIT_WORK(&mb0_transfer.mask_work, prcmu_mask_work);
 
-        /* Initalize irqs. */
-        for (i = 0; i < NUM_PRCMU_WAKEUPS; i++) {
-                unsigned int irq;
-
-                irq = IRQ_PRCMU_BASE + i;
-                irq_set_chip_and_handler(irq, &prcmu_irq_chip,
-                                         handle_simple_irq);
-                set_irq_flags(irq, IRQF_VALID);
-        }
         compute_armss_rate();
 }
 
@@ -3041,6 +3062,8 @@ static int __devinit db8500_prcmu_probe(struct platform_device *pdev)
                 goto no_irq_return;
         }
 
+        db8500_irq_init(np);
+
         for (i = 0; i < ARRAY_SIZE(db8500_prcmu_devs); i++) {
                 if (!strcmp(db8500_prcmu_devs[i].name, "ab8500-core")) {
                         db8500_prcmu_devs[i].platform_data = ab8500_platdata;