|
@@ -37,6 +37,7 @@ struct exynos_pm_domain {
|
|
|
struct clk *oscclk;
|
|
|
struct clk *clk[MAX_CLK_PER_DOMAIN];
|
|
|
struct clk *pclk[MAX_CLK_PER_DOMAIN];
|
|
|
+ struct clk *asb_clk[MAX_CLK_PER_DOMAIN];
|
|
|
};
|
|
|
|
|
|
static int exynos_pd_power(struct generic_pm_domain *domain, bool power_on)
|
|
@@ -45,14 +46,19 @@ static int exynos_pd_power(struct generic_pm_domain *domain, bool power_on)
|
|
|
void __iomem *base;
|
|
|
u32 timeout, pwr;
|
|
|
char *op;
|
|
|
+ int i;
|
|
|
|
|
|
pd = container_of(domain, struct exynos_pm_domain, pd);
|
|
|
base = pd->base;
|
|
|
|
|
|
+ for (i = 0; i < MAX_CLK_PER_DOMAIN; i++) {
|
|
|
+ if (IS_ERR(pd->asb_clk[i]))
|
|
|
+ break;
|
|
|
+ clk_prepare_enable(pd->asb_clk[i]);
|
|
|
+ }
|
|
|
+
|
|
|
/* Set oscclk before powering off a domain*/
|
|
|
if (!power_on) {
|
|
|
- int i;
|
|
|
-
|
|
|
for (i = 0; i < MAX_CLK_PER_DOMAIN; i++) {
|
|
|
if (IS_ERR(pd->clk[i]))
|
|
|
break;
|
|
@@ -81,8 +87,6 @@ static int exynos_pd_power(struct generic_pm_domain *domain, bool power_on)
|
|
|
|
|
|
/* Restore clocks after powering on a domain*/
|
|
|
if (power_on) {
|
|
|
- int i;
|
|
|
-
|
|
|
for (i = 0; i < MAX_CLK_PER_DOMAIN; i++) {
|
|
|
if (IS_ERR(pd->clk[i]))
|
|
|
break;
|
|
@@ -92,6 +96,12 @@ static int exynos_pd_power(struct generic_pm_domain *domain, bool power_on)
|
|
|
}
|
|
|
}
|
|
|
|
|
|
+ for (i = 0; i < MAX_CLK_PER_DOMAIN; i++) {
|
|
|
+ if (IS_ERR(pd->asb_clk[i]))
|
|
|
+ break;
|
|
|
+ clk_disable_unprepare(pd->asb_clk[i]);
|
|
|
+ }
|
|
|
+
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
@@ -131,6 +141,15 @@ static __init int exynos4_pm_init_power_domain(void)
|
|
|
pd->pd.power_off = exynos_pd_power_off;
|
|
|
pd->pd.power_on = exynos_pd_power_on;
|
|
|
|
|
|
+ for (i = 0; i < MAX_CLK_PER_DOMAIN; i++) {
|
|
|
+ char clk_name[8];
|
|
|
+
|
|
|
+ snprintf(clk_name, sizeof(clk_name), "asb%d", i);
|
|
|
+ pd->asb_clk[i] = clk_get(dev, clk_name);
|
|
|
+ if (IS_ERR(pd->asb_clk[i]))
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
pd->oscclk = clk_get(dev, "oscclk");
|
|
|
if (IS_ERR(pd->oscclk))
|
|
|
goto no_clk;
|