mfd: Provide the PRCMU with its own IRQ domain

The PRCMU has its own USB, Thermal, GPIO, Modem, HSI and RTC drivers,
amongst other things. This patch allows those subordinate devices to
use it as an interrupt controller as and when they are DT enabled.

Signed-off-by: Lee Jones <lee.jones@linaro.org>
Acked-by: Linus Walleij <linus.walleij@linaro.org>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>

1 files changed, 35 insertions, 12 deletions

diff --git a/drivers/mfd/db8500-prcmu.c b/drivers/mfd/db8500-prcmu.c
index 6fb11b76071e..bac4876d090f 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.
@@ -2623,7 +2625,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);
 
@@ -2637,7 +2639,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);
 
@@ -2677,9 +2679,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);
 
@@ -2724,15 +2754,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();
 }
 
@@ -3040,6 +3061,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;