soc: dove: add legacy support to PMU driver

Add support for legacy non-DT Dove to the PMU driver, so that we can
transition the legacy support over.

[gregory.clement@free-electrons.com: removed pm_genpd_poweroff_unused]
Acked-by: Arnd Bergmann <arnd@arndb.de>
Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
Signed-off-by: Gregory CLEMENT <gregory.clement@free-electrons.com>

3 files changed, 63 insertions, 0 deletions

diff --git a/drivers/soc/Makefile b/drivers/soc/Makefile
index f2ba2e932ae1..d52872680f86 100644
--- a/drivers/soc/Makefile
+++ b/drivers/soc/Makefile
@@ -3,6 +3,7 @@
 #
 
 obj-$(CONFIG_SOC_BRCMSTB)       += brcmstb/
+obj-$(CONFIG_ARCH_DOVE)         += dove/
 obj-$(CONFIG_MACH_DOVE)         += dove/
 obj-$(CONFIG_ARCH_MEDIATEK)     += mediatek/
 obj-$(CONFIG_ARCH_QCOM)         += qcom/
diff --git a/drivers/soc/dove/pmu.c b/drivers/soc/dove/pmu.c
index abd087917f80..039374e9fdc0 100644
--- a/drivers/soc/dove/pmu.c
+++ b/drivers/soc/dove/pmu.c
@@ -305,6 +305,49 @@ static int __init dove_init_pmu_irq(struct pmu_data *pmu, int irq)
         return 0;
 }
 
+int __init dove_init_pmu_legacy(const struct dove_pmu_initdata *initdata)
+{
+        const struct dove_pmu_domain_initdata *domain_initdata;
+        struct pmu_data *pmu;
+        int ret;
+
+        pmu = kzalloc(sizeof(*pmu), GFP_KERNEL);
+        if (!pmu)
+                return -ENOMEM;
+
+        spin_lock_init(&pmu->lock);
+        pmu->pmc_base = initdata->pmc_base;
+        pmu->pmu_base = initdata->pmu_base;
+
+        pmu_reset_init(pmu);
+        for (domain_initdata = initdata->domains; domain_initdata->name;
+             domain_initdata++) {
+                struct pmu_domain *domain;
+
+                domain = kzalloc(sizeof(*domain), GFP_KERNEL);
+                if (domain) {
+                        domain->pmu = pmu;
+                        domain->pwr_mask = domain_initdata->pwr_mask;
+                        domain->rst_mask = domain_initdata->rst_mask;
+                        domain->iso_mask = domain_initdata->iso_mask;
+                        domain->base.name = domain_initdata->name;
+
+                        __pmu_domain_register(domain, NULL);
+                }
+        }
+
+        ret = dove_init_pmu_irq(pmu, initdata->irq);
+        if (ret)
+                pr_err("dove_init_pmu_irq() failed: %d\n", ret);
+
+        if (pmu->irq_domain)
+                irq_domain_associate_many(pmu->irq_domain,
+                                          initdata->irq_domain_start,
+                                          0, NR_PMU_IRQS);
+
+        return 0;
+}
+
 /*
  * pmu: power-manager@d0000 {
  *      compatible = "marvell,dove-pmu";
diff --git a/include/linux/soc/dove/pmu.h b/include/linux/soc/dove/pmu.h
index 9c99f84bcc0e..765386972b55 100644
--- a/include/linux/soc/dove/pmu.h
+++ b/include/linux/soc/dove/pmu.h
@@ -1,6 +1,25 @@
 #ifndef LINUX_SOC_DOVE_PMU_H
 #define LINUX_SOC_DOVE_PMU_H
 
+#include <linux/types.h>
+
+struct dove_pmu_domain_initdata {
+        u32 pwr_mask;
+        u32 rst_mask;
+        u32 iso_mask;
+        const char *name;
+};
+
+struct dove_pmu_initdata {
+        void __iomem *pmc_base;
+        void __iomem *pmu_base;
+        int irq;
+        int irq_domain_start;
+        const struct dove_pmu_domain_initdata *domains;
+};
+
+int dove_init_pmu_legacy(const struct dove_pmu_initdata *);
+
 int dove_init_pmu(void);
 
 #endif