1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * MMP PMU power island support
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (C) 2020 Lubomir Rintel <lkundrak@v3.sk>
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <linux/pm_domain.h>
9*4882a593Smuzhiyun #include <linux/slab.h>
10*4882a593Smuzhiyun #include <linux/io.h>
11*4882a593Smuzhiyun
12*4882a593Smuzhiyun #include "clk.h"
13*4882a593Smuzhiyun
14*4882a593Smuzhiyun #define to_mmp_pm_domain(genpd) container_of(genpd, struct mmp_pm_domain, genpd)
15*4882a593Smuzhiyun
16*4882a593Smuzhiyun struct mmp_pm_domain {
17*4882a593Smuzhiyun struct generic_pm_domain genpd;
18*4882a593Smuzhiyun void __iomem *reg;
19*4882a593Smuzhiyun spinlock_t *lock;
20*4882a593Smuzhiyun u32 power_on;
21*4882a593Smuzhiyun u32 reset;
22*4882a593Smuzhiyun u32 clock_enable;
23*4882a593Smuzhiyun unsigned int flags;
24*4882a593Smuzhiyun };
25*4882a593Smuzhiyun
mmp_pm_domain_power_on(struct generic_pm_domain * genpd)26*4882a593Smuzhiyun static int mmp_pm_domain_power_on(struct generic_pm_domain *genpd)
27*4882a593Smuzhiyun {
28*4882a593Smuzhiyun struct mmp_pm_domain *pm_domain = to_mmp_pm_domain(genpd);
29*4882a593Smuzhiyun unsigned long flags = 0;
30*4882a593Smuzhiyun u32 val;
31*4882a593Smuzhiyun
32*4882a593Smuzhiyun if (pm_domain->lock)
33*4882a593Smuzhiyun spin_lock_irqsave(pm_domain->lock, flags);
34*4882a593Smuzhiyun
35*4882a593Smuzhiyun val = readl(pm_domain->reg);
36*4882a593Smuzhiyun
37*4882a593Smuzhiyun /* Turn on the power island */
38*4882a593Smuzhiyun val |= pm_domain->power_on;
39*4882a593Smuzhiyun writel(val, pm_domain->reg);
40*4882a593Smuzhiyun
41*4882a593Smuzhiyun /* Disable isolation */
42*4882a593Smuzhiyun val |= 0x100;
43*4882a593Smuzhiyun writel(val, pm_domain->reg);
44*4882a593Smuzhiyun
45*4882a593Smuzhiyun /* Some blocks need to be reset after a power up */
46*4882a593Smuzhiyun if (pm_domain->reset || pm_domain->clock_enable) {
47*4882a593Smuzhiyun u32 after_power_on = val;
48*4882a593Smuzhiyun
49*4882a593Smuzhiyun val &= ~pm_domain->reset;
50*4882a593Smuzhiyun writel(val, pm_domain->reg);
51*4882a593Smuzhiyun
52*4882a593Smuzhiyun val |= pm_domain->clock_enable;
53*4882a593Smuzhiyun writel(val, pm_domain->reg);
54*4882a593Smuzhiyun
55*4882a593Smuzhiyun val |= pm_domain->reset;
56*4882a593Smuzhiyun writel(val, pm_domain->reg);
57*4882a593Smuzhiyun
58*4882a593Smuzhiyun writel(after_power_on, pm_domain->reg);
59*4882a593Smuzhiyun }
60*4882a593Smuzhiyun
61*4882a593Smuzhiyun if (pm_domain->lock)
62*4882a593Smuzhiyun spin_unlock_irqrestore(pm_domain->lock, flags);
63*4882a593Smuzhiyun
64*4882a593Smuzhiyun return 0;
65*4882a593Smuzhiyun }
66*4882a593Smuzhiyun
mmp_pm_domain_power_off(struct generic_pm_domain * genpd)67*4882a593Smuzhiyun static int mmp_pm_domain_power_off(struct generic_pm_domain *genpd)
68*4882a593Smuzhiyun {
69*4882a593Smuzhiyun struct mmp_pm_domain *pm_domain = to_mmp_pm_domain(genpd);
70*4882a593Smuzhiyun unsigned long flags = 0;
71*4882a593Smuzhiyun u32 val;
72*4882a593Smuzhiyun
73*4882a593Smuzhiyun if (pm_domain->flags & MMP_PM_DOMAIN_NO_DISABLE)
74*4882a593Smuzhiyun return 0;
75*4882a593Smuzhiyun
76*4882a593Smuzhiyun if (pm_domain->lock)
77*4882a593Smuzhiyun spin_lock_irqsave(pm_domain->lock, flags);
78*4882a593Smuzhiyun
79*4882a593Smuzhiyun /* Turn off and isolate the the power island. */
80*4882a593Smuzhiyun val = readl(pm_domain->reg);
81*4882a593Smuzhiyun val &= ~pm_domain->power_on;
82*4882a593Smuzhiyun val &= ~0x100;
83*4882a593Smuzhiyun writel(val, pm_domain->reg);
84*4882a593Smuzhiyun
85*4882a593Smuzhiyun if (pm_domain->lock)
86*4882a593Smuzhiyun spin_unlock_irqrestore(pm_domain->lock, flags);
87*4882a593Smuzhiyun
88*4882a593Smuzhiyun return 0;
89*4882a593Smuzhiyun }
90*4882a593Smuzhiyun
mmp_pm_domain_register(const char * name,void __iomem * reg,u32 power_on,u32 reset,u32 clock_enable,unsigned int flags,spinlock_t * lock)91*4882a593Smuzhiyun struct generic_pm_domain *mmp_pm_domain_register(const char *name,
92*4882a593Smuzhiyun void __iomem *reg,
93*4882a593Smuzhiyun u32 power_on, u32 reset, u32 clock_enable,
94*4882a593Smuzhiyun unsigned int flags, spinlock_t *lock)
95*4882a593Smuzhiyun {
96*4882a593Smuzhiyun struct mmp_pm_domain *pm_domain;
97*4882a593Smuzhiyun
98*4882a593Smuzhiyun pm_domain = kzalloc(sizeof(*pm_domain), GFP_KERNEL);
99*4882a593Smuzhiyun if (!pm_domain)
100*4882a593Smuzhiyun return ERR_PTR(-ENOMEM);
101*4882a593Smuzhiyun
102*4882a593Smuzhiyun pm_domain->reg = reg;
103*4882a593Smuzhiyun pm_domain->power_on = power_on;
104*4882a593Smuzhiyun pm_domain->reset = reset;
105*4882a593Smuzhiyun pm_domain->clock_enable = clock_enable;
106*4882a593Smuzhiyun pm_domain->flags = flags;
107*4882a593Smuzhiyun pm_domain->lock = lock;
108*4882a593Smuzhiyun
109*4882a593Smuzhiyun pm_genpd_init(&pm_domain->genpd, NULL, true);
110*4882a593Smuzhiyun pm_domain->genpd.name = name;
111*4882a593Smuzhiyun pm_domain->genpd.power_on = mmp_pm_domain_power_on;
112*4882a593Smuzhiyun pm_domain->genpd.power_off = mmp_pm_domain_power_off;
113*4882a593Smuzhiyun
114*4882a593Smuzhiyun return &pm_domain->genpd;
115*4882a593Smuzhiyun }
116